AD-A267  542 


National  Odfanae 
I  Defence  Rationale 


SOME  APPUCATIONS  OF  KALMAN  FILTERING  IN 
ADVANCED  UND  HRE  CONTROL  SYSTEMS  (U) 


by 

J.S.  Bird 


1  This  documrni  has  been  approved 
I  lor  public  role  CSC-  and  sale;  its 
j  dioiributton  is  uniunited. _ 


93-18509 


DEFENCE  RESEARCH  ESTABLISHMENT  OTTAWA 

REPORT  NO.  1172 


O  ^ 


Canad'a 


April  1993 
Ottawa 


me  QUALIT7  INSPECTED  3 


SOME  APPLICATIONS  OF  KALMAN  FILTERING  IN 
ADVANCED  LAND  FIRE  CONTROL  SYSTEMS  (U) 

by 

J.S.  Bird 

Communications  and  Navigation  Systems  Section 
Electronics  Division 


DEFENCE  RESEARCH  ESTABLISHMENT  OTTAWA 

REPORT  NO.  1172 


PCN 

1410SC 


April  1993 
Ottawa 


ABSTRACT 


This  report  describes  several  potential  applications  of  Kalman  filters  for  advanced  land  fire 
control  systems.  Two  areas  that  are  especMy  important  in  the  moving-target  /  moving-platform 
scenario  are  addressed  in  some  detail:  the  tracking  and  trajectory  prediction  of  multiple 
maneuvering  targets  and  the  prediction  of  gun  pointing  angles  in  the  instant  before  firing.  This 
is  particularly  important  in  the  design  of  a  dynamic  muzzle  reference  system.  The  equations  for 
the  filters  are  developed,  simulations  are  described,  and  some  real  data  is  processed  through  the 
muzzle  angle  prediction  filter.  An  architecture  for  a  complete  advanced  land  fire  control  system 
is  proposed. 


R^SUM^ 


Ce  rapport  ddcrit  plusieurs  applications  potentielles  de  filtres  Kalman  pour  les  syst^mes  avanc^s 
de  controle  d’artillerie  au  sol.  Deux  secteurs  qui  sont  spdcialement  importants  dans  le  sdnario 
plate-forme  mobile/cible  mobile  sont  abord6s  dans  certains  details:  la  prediction  de  la  capture  et 
de  la  trajectoire  de  cibles  manoeuvres  multiples  et  la  prediction  de  I’angle  de  vise  du  canon 
au  moment  precddant  le  feu.  Ceci  est  particulierement  important  dans  la  conception  d’un  syst^me 
e  reference  dynamique  de  goulot  Les  equations  des  filtres  sont  developpdes,  des  simulations 
sont  decrites,  et  es  (tonnes  relies  sont  traites  par  le  filtre  de  prediction  e  Tangle  du  canon. 
Une  architecture  d’un  systome  avance  complet  e  contrdle  d’artillerie  au  sol  y  est  propose. 


EXECUTIVE  SUMMARY 


The  Defence  Research  Establishment  Ottawa  CDREO)  was  asked  to  look  at  potential 
applications  of  Kalman  Filtering  technology  m  various  aspects  of  mobile  land  fire  control 
systems,  with  particular  emphasis  on  the  reduction  of  errors  in  the  moving-target,  moving- 
platform  scenario.  Such  errors  are  exacerbated  by  the  high  dynamic  environment,  for  example, 
when  targets  are  tracked  manually  and  when  shells  are  launched  through  a  flexing  gun  barrel. 

Today’s  direct-fire  support  vehicles  (DFSV)  have  large  gims  that  are  inertially  stabilized, 
day  and  night  sighting  systems,  pulsed  laser  range  finders,  and  digital  fire  control  computers  to 
calculate  lead  angles  that  correct  for  target  range  and  crossing  velocity,  weather  conditions,  etc. 
However  increasing  requirements  for  high  accuracy  at  extended  ranges  while  firing  on  the  move 
have  meant  that  a  new  generation  fire  control  system  will  be  required  to  remove  even  more 
sources  of  error. 

Improvements  in  sensor  technology  and  the  decreasing  cost  and  size  of  high-speed 
computers  has  created  opportunities  for  sophisticated  signal  processing  algorithms  aboard 
tomorrow’s  land  vehicles.  Many  tasks  that  crews  find  extremely  difficult  can  often  be  routinely 
done  in  a  computer.  For  example,  accurately  tracking  a  moving  target  when  one’s  own  vehicle 
is  boimcing  wildly  over  rough  terrain  is  nearly  impossible  for  the  guimer  but  is  a  fairly  simple 
exercise  in  target  tracking  for  an  image  processing  computer.  As  well,  present  ballistic 
computers  use  relatively  simple  look-up  tables  because  of  the  limitations  of  on-board  processing 
power.  Modem  computers  can  compute  and  effect  much  more  accurate  gun  laying  angles  that 
take  into  account  more  up-to-the-millisecond  gun  barrel  sensor  information.  However,  at  present, 
few  land  vehicles  exist  with  such  capabilities. 

Kalman  filtering  is  a  signal  processing  technique  that  has  tremendous  potential  for  next 
generation  fire  control.  It  can  address  most  of  the  remaining  error  sources,  provided  that  they 
can  be  mathematically  modelled  and  that  sensitive  sensors  are  installed  to  measure  such  errors. 
Its  predictive  nature  makes  it  ideally  suited  to  estimate  where  the  target  is  going  to  be  when  the 
shell  arrives,  for  example,  or  when  the  gun  barrel  is  going  to  be  pointed  in  the  correct  direction. 

This  report  will  first  summarize  the  fundamentals  of  the  Kalman  filter  algorithm  and  give 
some  simple  examples  of  how  it  is  used  in  common  military  systems.  Next,  a  series  of  problem 
areas  in  mobile  fire  control  systems  that  can  benefit  from  the  application  of  the  filter  will  be 
described.  Two  areas  that  were  studied  in  some  detail,  namely  target  tracking  and  dynamic 
muzzle  referencing  will  be  the  focus  of  subsequent  chapters.  The  equations  used  to  design  the 
filters  will  be  developed;  a  software  simulator  that  implements  the  filter  is  described;  simulations 
of  tracking  performance  are  demonstrated;  and  real  barrel  flex  data  is  processed  through  a 
candidate  pointing  angle  filter  for  a  predictive  muzzle  reference  system.  Broadening  the  scope 
somewhat,  the  next  chapter  outlines  a  potential  architecture  for  an  Advanced  Development  Model 
(ADM)  that  encompasses  these  subsystems  as  well  as  those  related  to  image  processing,  vehicle 
dynamics,  human  interaction,  etc. 
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1.0  INTRODUCTION  TO  ADVANCED  LAND  FIRE  CONTROL 


1.1  BACKGROUND  OF  THE  RESEARCH  PROJECT 


As  part  of  DLAEEM  Task  139  -  "Kalman  Filter  Design  for  Tank  Fire  Control  Systems," 
the  Defence  Research  Establishment  Ottawa  (DREO)  was  asked  to  look  at  potential  applications 
of  Kalman  filtering  technology  in  various  aspects  of  mobile  land  fire  control  systems,  with 
particular  emphasis  on  the  reduction  of  errors  in  the  moving-target,  moving-platform  scenario. 
Such  errors  are  exacerbated  by  the  high  dynamic  environment,  for  exan^le,  when  targets  are 
tracked  manually  and  when  shells  are  launched  through  a  flexing  gun  barrel. 

The  task  description  sheet  specified  the  following  general  aim:  "To  conduct  a  design  and 
feasibility  study  for  an  MET  (Main  Battle  Tank)  positioning  and  target  tracking  system."  Among 
the  work  items  were  the  following: 

•  develop  dynamical  models  for  tank/target  motion  and  robust  algorithms  for  Kalman 
filter  tracking,  prediction,  error  estimation,  motion  compensation,  sensor  integration; 

•  develop  a  software  simulation  test-bed  to  evaluate  the  algorithms  against  real  or 
simulated  data  in  a  variety  of  motion  scenarios; 

•  analyze  the  simulations  and  identify  the  effects  of  the  algorithms  on  tracking 
performance;  and 

•  recommend  hardware  and  software  configurations  for  possible  advanced  development 
model  construction. 

The  original  tasking  was  very  broad  by  intent  and  it  was  expected  that  research  directions 
would  shift  as  it  became  apparent  which  were  the  primary  error  sources  that  might  be  solved  by 
these  filtering  techniques.  For  example,  the  extent  of  terrain-induced  muzzle  motion  was 
underestimated  until  discussions  were  held  with  several  tank  gtm  experts.  Characterization, 
analysis  and  methods  for  compensation  of  these  motions  subsequently  became  one  of  the  largest 
areas  of  study.  On  the  other  hand,  battlefield  navigation,  as  specifically  mentioned  in  the  aim 
of  the  task  description  sheet,  took  on  a  lower  priority  since  it  did  not  affect  fire  control  accuracy 
per  se,  though  it  is  an  area  where  the  application  of  a  Kalman  filter-based,  integrated  land 
navigation  system  would  enhance  the  overall  survivability  of  the  platform  on  the  battlefield. 

In  fact,  the  project  directions  became  so  broad  that  other  establishments  a  id  several 
contractors  became  involved.  During  the  course  of  this  task,  an  Inter-Establishment  Working 
Arrangement  (lEWA)  was  initiated  to  bring  together  researchers  from  DREO,  DREV  (Defence 
Research  Establishment  Valcartier),  DRES  (Suffield),  and  DCIEM  (the  Defence  and  Civil 
Institute  for  Environmental  Medicine)  that  were  working  in  various  aspects  of  land  vehicles  and 
fire  control.  As  well,  a  major  development  program  (D6374)  was  initiated  to  carry  on  the  work 
and  deliver  a  field-testable  model  of  an  advanced  fire  control  system  that  could  demonstrate  the 
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techniques  of  this  report  and  those  of  the  oJier  investigators. 

The  work  summarized  in  this  report  was  carried  out  from  May  1988  to  December  1990 
\mder  project  no.  PCN  0318E. 


1.2  BUILDING  ON  MODERN  DAY  FIRE  CONTROL  SYSTEMS 


Today’s  direct-fire  support  vehicles  (DFSV)  generally  have  good  fire  control  systems, 
especially  when  compared  to  their  forerunners  of  World  War  n.  Gone  are  the  days  when  the 
drivers  of  turretless  tanks  stopped  to  face  each  other  on  the  battlefield  and  fired  volleys  of  hand- 
aimed  shells.  Modem  DFSV’s  have  large  guns  that  are  stabilized  in  azimuth  and  elevatio'>  (to 
allow  a  reasonably  steady  aimpoint  when  the  vehicle  is  moving),  long-range  (out  to  several 
kilometres)  stabilized  day  and  night  vision  sighting  systems,  and  pulsed  laser  range  finders  to 
measure  target  range  to  within  a  few  meters.  Most  have  digit^  fire  control  computers  to 
calculate  lead  angles  and  elevation  offsets  that  correct  for  target  range  and  crossing  velocity,  wind 
speed  and  direction,  air  pressure,  ammunition  type  and  temperature,  sight  parallax  and  even  the 
static  droop  of  the  gun  barrel  as  it  warms.  However,  increasing  requirements  for  high  accuracy 
at  extended  ranges,  while  firing  on  the  move,  have  meant  that  a  new  generation  fire  control 
system  will  be  required  to  remove  even  r  .ore  sources  of  error. 

Given  the  level  of  sophistication  of  the  equipment  in  a  modem  armoured  vehicle,  one  can 
ask  the  fair  question:  is  there  any  more  that  can  be  done?  The  answer  of  course,  is  yes;  several 
countries  are  rigorously  pursuing  mobile  land  fire  control  research  and  several  NATO  and  TTCP 
panels  and  action  groups  have  been  initiated  to  investigate  outstanding  problem  areas  and  identify 
sources  of  errors  that  are  presently  limiting  fire  control  performance.  TTCP  Panel  W,  Action 
Group  10  (WAG-10)  visited  several  US,  UK  and  Canadian  organizations  pursuing  such  issues 
(and  more  as  their  mandate  referred  to  tank  gun  accuracy  in  general).  The  final  report,  (TTCP- 
WAGIO  (1989)),  summarized  the  primary  error  sources  and  recommended  the  creation  of  two 
Key  Technical  Areas,  KTA  5-17  "Advanced  Integrated  Tank  Fire  Control,"  and  KTA  2-11  "Sabot 
Separation,”  to  further  investigate  them. 

Among  the  findings  of  WAG- 10  was  that  among  the  major  sources  of  error  in  a  typical 
state-of-the-art  main  battle  tank  engaging  a  moving  target,  while  itself  moving  cross  country,  was 
1)  the  inability  of  the  gun  to  remain  pointed  in  the  proper  direction,  and  2)  the  inability  of  the 
gunner  to  maintain  a  sufficiently  accurate  aimpoint  on  a  maneuvering  target  Though  the 
magnitudes  of  the  errors  are  fairly  small,  on  the  order  of  1  milliradian  or  so  (or  about  1/20  of 
a  degree  or  3  arc  minutes),  in  the  context  of  the  modem  battlefield,  errors  of  even  these 
magnitudes  can  be  disastrous,  especially  if  the  adversary  has  a  comparable  system.  Modem  high- 
intensity  battles  are  fought  at  ranges  from  a  few  hundred  meters  out  to  a  few  kilometers.  Even 
at  a  nominal  battle  range  of  1200  meters,  a  1  mrad  pointing  error  means  a  miss  distance  (fiom 
the  desired  aimpoint)  of  1.2  meters  (1200  x  tan  0.001).  This  may  mean  the  difference  between 
disabling  the  target  and  missing  it  entirely  (typical  practice  targets  are  2.3  m  wide). 
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Improvements  in  sensor  technology  and  the  decreasing  cost  and  size  of  high-speed 
computers  have  created  opportunities  for  sophisticated  signal  processing  algorithms  aboard 
tomorrow’s  land  vehicles.  Many  tasks  that  crews  find  extremely  difficult  can  often  be  routinely 
done  in  a  computer.  For  example,  accurately  tracking  a  moving  target  when  one’s  own  vehicle 
is  bouncing  wildly  over  rough  terrain  is  nearly  impossible  for  the  gunner  but  is  a  fairly  simple 
exercise  in  target  tracking  for  an  image  processing  computer.  As  well,  present  ballistic 
computers  use  relatively  simple  look-up  tables  because  of  the  limitations  of  on-board  processing 
power.  Modem  computers  can  compute  and  effect  much  more  accurate  gun  laying  angles  that 
take  into  account  more  up-to-the-milUsecond  gun  barrel  sensor  information.  However,  at  present, 
few  land  vehicles  exist  with  such  capabilities.  It  should  be  mentioned,  on  the  other  hand,  that 
there  are  some  tasks  that  are  relatively  simple  for  humans  but  exceedingly  difficult  for  computers 
-  target  recognition,  for  example.  Research  into  such  algorithms  is  progressing,  however,  and 
may  one  day  be  feasible  in  fire  control  systems. 

Kalman  filtering  is  a  signal  processing  technique  that  has  tremendous  potential  for  next 
generation  fire  control.  It  can  address  most  of  the  remaining  error  sources,  provided  that  they 
can  be  mathematically  modelled  and  that  sensitive  sensors  are  installed  to  measure  such  errors. 
Its  predictive  nature  makes  it  ideally  suited  to  stimate  where  the  target  is  going  to  be  when  the 
shell  arrives,  for  example,  or  when  the  gun  barrel  is  going  to  be  pointed  in  the  correct  direction. 
The  filter,  named  after  Rudy  Kalman  who  developed  it  in  the  early  1960’s,  is  a  method  of 
estimating  the  true  state  of  an  imprecisely  known  dynamical  system  from  noisy  measurements. 
Since  this  describes  almost  every  system  that  one  has  to  deal  with  in  practice,  it  is  not  surprising 
that  the  Kalman  filter  has  seen  tremendous  application  in  many  fields;  everything  from  target 
tracking  to  navigation  to  communications  to  economics.  A  very  good  collection  of  both 
theoretical  and  applications  papers  is  available  in  Sorenson  (1985).  The  filter  can  be  relatively 
computationally  intensive  and,  until  recent  generations  of  microprocessors,  its  real-time 
applications  have  often  required  approximations  or  other  ad-hoc  modifications.  Now  however, 
large  size  filters  are  routinely  implemented  in  real-time. 


1.3  THE  SCOPE  OF  THIS  REPORT 


This  report  will  first  summarize  the  fundamentals  of  the  Kalman  filter  algorithm  and  give 
some  simple  examples  of  how  it  is  used  in  common  military  systems.  Next,  a  series  of  problem 
areas  in  mobile  fire  control  systems  that  can  benefit  from  the  application  of  the  filter  'vill  be 
described.  Two  areas  that  were  studied  in  some  detail,  namely  target  tracking  and  dynamic 
muzzle  referencing  will  be  the  focus  of  the  next  chapters.  The  equations  used  to  design  the 
filters  will  be  developed;  a  software  simulator  that  implements  the  filter  is  described;  simulations 
of  tracking  performance  are  demonstrated;  and  real  barrel  flex  data  is  processed  through  a 
candidate  pointing  angle  filter  for  a  predictive  muzzle  reference  system.  Broadening  the  scope 
somewhat,  the  next  chapter  outlines  a  potential  architecture  for  an  Advanced  Development  Model 
(ADM)  that  encompasses  these  subsystems  as  well  as  those  related  to  image  processing,  vehicle 
dynamics,  human  interaction,  etc. 
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2.0  KALMAN  FILTERING  FUNDAMENTALS 


2.1  CONCEPTS 


A  Kalman  filter  is  a  minimum  variance  estimator  that  can  be  used  to  esou^ate,  predict 
and/or  smooth  the  true  state  of  an  imprecisely  known  dynamical  system  from  noisy  measure¬ 
ments.  It  is  usually  implemented  in  software  as  a  digital  filtering  algorithm  but  in  the  past, 
steady-state  Kalman  filter  approximations  were  often  implemented  in  analog  hardware. 

It  is  fairly  straightforward  to  describe  the  operation  of  the  filter  in  words.  First,  a 
mathematical  model  is  derived  that  describes  the  state  of  the  system  to  be  estimated.  This  is 
often  in  the  form  of  a  set  of  differential  equations.  The  filter  also  allows  for  a  noise  process  to 
enter  the  state  equations,  which  models  the  random  or  uncertain  nature  of  their  evolution. 
Another  set  of  equations  that  relates  the  sensor  measurements  to  the  system  states  is  derived  and 
knowledge  of  the  type  of  noise  that  the  sensors  generate  is  also  required.  Finally,  the  filter  must 
be  given  a  rough  initial  estimate  of  the  true  state  and  a  guess  of  the  accuracy,  in  the  form  of  an 
initial  error  covariance  matrix,  of  that  initial  state  estimate. 

The  filter  operates  in  a  recursive  mode.  With  its  initial  estimate  oi  the  state,  and  the 
differential  equations  describing  the  evolution  of  the  state,  the  filter  algorithm  can  propagate  the 
state  estimate  forward  to  any  point  in  time.  However,  given  the  noise  and  uncertainty  inherent 
in  the  system  model,  the  estimate  will  start  to  diverge  from  the  true  state.  When  sensor  data  is 
available,  the  filter  removes  as  much  noise  from  it  as  possible  by  extracting  the  maximum 
amount  of  information.  It  then  uses  this  information  to  correct  its  estimate  of  the  state.  At  this 
point,  the  error  in  the  state  estimate  will  have  been  reduced  substantially.  The  filter  then 
propagates  its  new  state  estimate  forward  in  time  until  more  sensor  data  is  available. 


2.2  SOME  POSSIBLE  APPLICATIONS  IN  FIRE  CONTROL 

Kalman  filters  appear  in  many  military  systems  in  various  forms.  Often  they  are  only 
simple  approximations  to  the  full  filter  (because  of  the  number  of  computations  that  must  be 
performed  at  each  time  step)  but  they  still  perform  fairly  well.  A  conunon  example  of  such  an 
approximation  is  the  a-P  or  a-^-y  target  tracker.  Modem  battlefield  computers  now  have  the 
capacity  to  routinely  implement  the  fiill  set  of  filter  equations  at  a  very  high  rate  enabling  the 
particular  system  to  achieve  better  accuracy  and  reliability. 

There  are  many  systems  aboard  mobile  land  vehicles  that  can  benefit  from  the  integration 
of  a  Kalman  filter  into  the  fire  control  system.  Two  areas  that  have  seen  the  near  universal 
application  of  the  filter  are  multi-sensor  integrated  navigation  systems  and  advanced  target 
tracking  systems.  In  fact,  the  filter  was  developed  for  navigation  systems  in  the  1960’s  and 
nearly  all  integrated  navigation  systems  in  service  today  have  a  Kalman  filter  at  the  heart  of  their 
processing  algorithms.  Tracking  systems  are  ideally  suited  to  the  algorithm  because  of  the 
inherent  filtering  and  prediction  operations  that  are  necessary  for  accurate  tracking  without  loss 
of  lock  diuing  target  maneuvers  or  obscurations.  The  tracking  application  of  the  filter  will  be 
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expanded  upon  in  a  later  chapter.  Dynamic  muzzle  referencing  is  a  relatively  new  idea  that  is 

also  an  excellent  candidate  for  the  Kalman  filter  algorithm.  These  potential  applications  are 

briefly  described  in  the  following  paragraphs. 

a)  Navisation  -  Accurate  positioning  on  the  battlefield  at  night,  in  adverse  weather  or  on 

featureless  terrain  has  proven  to  be  a  tremendous  advantage  in  modem  warfare.  The 
advent  of  GPS  (the  Global  Positioning  System)  has  allowed  individual  vehicles  to 
obtain  very  accurate  position  and  velocity  information  (at  discrete  times)  very 
inexpensively.  The  integration  (via  a  Kalman  filter)  of  GPS  and  an  inexpensive 
inertial  navigation  system  (INS)  greatly  improves  the  accuracy  and  reliability  of  the 
system  because  the  filter  uses  the  GPS  data  to  help  remove  the  errors  from  the  INS 
and  the  INS  provides  continuous  position,  velocity  and  attitude  information  and  can 
navigate  through  outages  or  obscurations  of  the  GPS  satellites.  A  simplified  INS/GPS 
system  is  used  as  an  example  later  in  this  chapter  to  demonstrate  the  idea  behind 
Kalman  filter  based  sensor  integration. 

b)  Tar  set  Tracking  -  Manual  tracking  of  a  distant  target  through  a  high-power  optical  sight 

is  not  easy.  Even  though  the  mirrors  in  the  sight  are  often  inertially  stabilized, 
providing  a  reasonably  steady  image  of  the  target  and  the  background,  the  sight’s 
eyepiece  and  the  guruier’s  head,  for  that  maner,  are  not.  One  can  imagine  trying  to 
look  through  the  eyepiece  and  make  minute  adjustments  with  the  hand  controls  to  keep 
the  target  in  the  center  of  the  sight  wliile  being  jostled  about  by  the  vehicle  as  it  is 
moving  at  high  speed  over  rough,  uneven  terrain.  Trying  to  keep  one’s  head  steady 
and  to  keep  one’s  hands  firom  transmitting  motions  into  the  controls  is  exceedingly 
difficult.  An  image  processing  system  attached  to  the  sight  offers  many  possibilities 
to  improve  performance.  Automatic  tracking  algorithms  can  lock  onto  the  target  and 
keep  it  in  the  center  of  the  field  of  view.  Alleviating  the  gurmer  of  this  intensive  task 
can  free  him  for  other  functions.  The  tracking  algorithm  can  be  a  Kalman  filter,  or 
perhaps  a  simplified  variation  of  one,  that  uses  a  mathematical  model  of  the  dynamics 
of  the  target  along  with  azimuth  and  elevation  measurements  of  the  target  from  the 
image  processing  system,  to  determine  its  most  probable  position  at  the  next  time  step. 
This  can  be  fed  back  to  the  image  processing  algorithm  to  aid  it  in  determining  what 
portion  of  the  field  of  view  should  be  concentrated  on  to  locate  the  target  in  the  next 
frame,  especially  if  the  target  has  briefly  disappeared  behind  an  obscuration. 

c)  Tamer  State  Estimation  /  Trajectory  Prediction  -  Most  current  fire  control  systems  assume 

very  simplistic  target  dynamics  when  computing  lead  angles.  For  example,  the  target 
is  often  assumed  to  be  travelling  at  a  constant  horizontal  velocity  with  no  vertical 
velocity.  This  simplifies  the  lead  angle  computations,  since  horizontal  lead  will  be  a 
function  of  the  angular  rate  of  the  turret  (caused  by  the  gunner  rotating  the  sight  to 
keep  the  target  centered)  and  the  range  to  the  target,  while  the  vertical  lead  is  only  a 
function  of  the  range  (plus  the  usual  shell  flight  compensation  terms,  etc.).  A 
trajectory  prediction  filter,  similar  to,  but  somewhat  more  complicated  than,  a  filter 
used  in  the  tracker  in  an  image  processing  system,  can  be  designed  to  predict  with 
much  more  accuracy,  the  location  of  the  target  at  the  expected  time  of  impact  of  the 
shell.  Such  a  filter  can  estimate  target  acceleration,  as  well  as  velocity,  in  all  three 
directions  -  range,  cross  range,  and  vertical.  This  would  greatly  enhance  the  accuracy 
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of  the  fire  control  system  against  highly  maneuverable  targets  such  as  high-speed 
evasive  ground  targets  and,  especially,  helicopters. 


d)  Stabilization  System  Error  Compensation  -  The  gtm  and  turret  stabilization  systems  on 

current  land  vehicles  are  good,  but  they  are  not  perfect.  Under  static  conditions,  a 
modem  electric  drive,  or  even  a  later-generation  hydraulic  drive,  can  position  the  gun 
to  within  a  fraction  of  a  milliradian  of  the  desired  position.  However,  under  dynamic 
conditions  the  gun  control  system  will  be  unable  to  remove  all  of  the  motion 
disturbances.  Current  DFSV’s  often  use  a  simple  "fire  inhibit"  scheme  that  prevents 
firing  until  the  gun  is  sufficiently  aligned  to  the  target  If  these  motions  can  be 
reasonably  well  modelled,  a  Kalman  filter  based  compensation  system  could  be 
designed  to  predict  when  the  stabilization  system  will  have  the  gim  pointing  in  the 
proper  direction. 

e)  Dynamic  Muzzle  Referencine  -  The  terrain-induced  flexing  of  the  gun  barrel  will  result  in 

the  muzzle  of  the  barrel  pointing  in  a  different  direction  than  the  gun  control  system 
assumes  it  is.  These  motions  can  be  reasonably  well  modelled  and  hence  can  be  used 
in  a  Kalman  filter  based  compensation  system  to  predict  when  the  muzzle  will  be 
pointing  in  the  desired  direction.  This  is  the  subject  of  Chapter  6.  The  ignition  of  the 
charge  can  be  delayed  for  a  few  milliseconds  so  that  the  shot  exit  time  coincides  with 
a  barrel  flex  zero-crossing  time. 


2.3  KALMAN  FILTER  EQUATIONS 


The  Kalman  filter  equations  can  be  given  in  several  forms,  since  they  have  been  developed 
for  both  continuous  and  excrete  time,  linear  and  nonlinear,  and  time-varying  or  time-invariant 
systems.  Here  we  will  show  the  case  of  the  linear,  discrete,  time-invariant  form.  The  reader  is 
referred  to  e.g.  Gelb  (1974)  for  other  variations  and  more  complete  derivations. 

Let  Xj^  denote  a  vector  (generally,  bold  face  will  denote  vectors  and  capitals  will  denote 
matrices,  E(«)  denotes  expected  value  and  :=  denotes  a  definition)  of  dimension  n  representing 
the  true  state  of  a  linear,  discrete-time  system  at  time  index  k: 

^k  (2-1) 

where  is  a  known  ny.)  matrix  governing  the  transition  of  the  state  from  time  tf^  to  and 
is  an  n-dimension'’!,  zero  mean,  Gaussian  random  vector  with  covariance  that  enters  the 
system  at  tj^  and  perturbs  the  state  in  a  random  manner.  This  type  of  model  is  often  assumed  to 
have  arisen  from  a  continuous  time  system  of  the  form 

xjit)  =  Fxj^t)  +  w^{t)  (2-2) 
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where  x^it)  =dxjdt  denotes  the  time  derivative  of  the  continuous  time  signal,  xjif).  Here,  w^it) 
is  a  continuous  time,  zero  mean,  uncorrelated  Gaussian  stochastic  process  vector  with  power 
spectral  density  matrix  QJit), 


E  =  Q^COSCf-T) 

where  5(r)  is  the  Dirac  delta  functional.  Equation  (2-2)  can  be  discretized  to  obtain  the 
difference  equation  (2-1)  via: 

(2-3) 

•'U 

It  is  assumed  that  the  sensors  of  the  system  provide  information  about  elements  of  the  state 
vector  at  time  but  that  this  may  be  corrupted  by  noise.  This  is  represented  by 

2*  =  ^k^k  +  ^k  (2-4) 


where  is  an  m-dimensional  vector  of  measurements,  is  a  known  mxn  matrix  relating  these 
measurements  to  the  system  states,  and  is  an  m-dimensional  random  noise  sequence  that 
corrupts  the  sensor  data. 


Certain  simplifying  assumptions  are  usually  made  about  the  noise  sequences,  though  they 
are  not  all  necessary  in  the  most  general  Kalman  filter  formulations  and  can  often  be  relaxed. 
The  measurement  noise  is  assumed  to  be  a  zero-mean,  Gaussian  sequence  with  covariance  Ji/^, 
and  is  uncorrelated  with  the  iititial  state,  the  state  noise,  and  previous  values  of  itself: 


E(vp  =  0,  E(y,yJ)  = 


E(v^wJ)  =  0,  E(Vj^xJ^)  =  0 


(2-5) 


where  is  the  Kronecker  delta  function  defined  as 


j=k 


The  state  noise  is  assumed  to  have  a  similar  form: 
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E(wp  =  0 


=  Q^hj  (2-6) 

E(wj^q)  =  0 

In  order  to  start  the  Kalman  filter,  an  initial  estimate  of  the  state  and  its  covariance,  P,  must 
be  given.  Often,  the  designer  has  some  knowledge  of  the  statistics  of  the  initial  state  vector  so 
the  initial  state  estimate  is  set  to  the  expected  value  of  the  true  state: 


^0  “  ^(-*^0) 

^0  “  E{(jfQ-iQ)(jfQ-fQ)^} 


(2-7) 


(In  practice,  though,  the  first  few  measurements  are  often  used  to  estimate  the  initial  states.) 

Given  all  these  assumptions,  the  Kalman  filter  will  produce  the  optimal  linear  estimate  of 
the  true  state  at  time  k,  given  all  available  measurements.  Optimal,  here,  is  defined  as  the 
unbiased  linear  estimator  which  has  the  minimum  variance  or  minimum  mean  square  error.  That 
is,  the  state  estimate  is  chosen  fiom  the  set  of  all  possible  i  vectors  to  satisfy 

E{x  -  i)  =  0 

r  (2-8) 

and,  min  E{(x-je)^(x-je)} 

£ 

Let  Zf^  denote  the  set  of  all  measurements  up  to  and  including  time  k: 

~  (2*9) 


One  can  show  that  the  value  of  i  that  satisfies  (2-8)  is  given  by  the  conditional  expectation  of 
X  given  all  the  measurements  up  to  r^.  This  will  be  denoted  by 

The  covariance  matrix  of  the  estimation  error  at  time  given  measurements  up  to  that  time  will 
be  denoted  by 


^k\k  ••=  E{[x*-i^,^][x^-f^,;t]^} 

Similarly,  the  optimal  estimate  of  x  given  only  the  measurements  up  to  is 
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and  the  corresponding  error  covariance  matrix  is 

^k\k~l  •= 

The  Kalman  iteration  proceeds  with  an  update^  followed  by  a  propagate.  A  block  diagram 
of  a  general  Kalman  filter  is  shown  in  Fig.  2-1.  For  the  update,  assume  that  estimates  of  the 
state  vector  and  its  covariance  matrix  are  available  at  that  make  use  of  all  measurements  up 
to  i.e.,  •  When  a  new  measurement,  Zj^,  arrives,  the  Kalman  filter  updates 

its  estimate  of  the  state  with  the  following: 


(2-10) 


Sensor  Measurement 


Fig.  2-1:  The  General  Kalman  Filter  Algorithm 
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A  closer  look  at  this  update  equation  shows  that  the  filter  improves  its  estimate  of  the  state  by 
adding  a  correction  term  to  its  previous  estimate.  This  correction  is  formed  by  taking  the 
residual  (the  difference  between  the  sensor  measurement,  and  the  estimate  of  what  the 
measurement  should  be,  )  and  then  multiplying  this  by  the  Kalman  gain  matrix,  Kj^  The 

gain  matrix  is  chosen  to  satisfy  (2-8)  and  can  be  shown  to  be  given  by 


(2-11) 

The  filter  also  updates  its  estimate  of  the  error  covariance  matrix  at  this  time  via 

(2-12) 

From  this  equation,  it  is  reasonable  to  see  (and,  in  fact,  can  be  shown)  that  the  error  covariance 
matrix  will  become  smaller,  since  a  term  is  being  subtracted  firom  its  previous  value.  Thus  the 
Kalman  filter  has  reduced  the  uncertainty  in  its  error  estimate  when  it  has  been  updated  with  a 
new  measurement. 

The  purpose  of  the  other  stage  of  the  filter,  the  propagate  stage,  is  to  advance  the  current 
estimates  of  the  state  and  the  error  covariance  ahead  in  time  until  the  next  oKasurement  becomes 
available  at  h+l'  This  step  is  relatively  simple  as  it  merely  uses  the  transition  matrix  (or 
dynamics  matrix,  as  in  Fig.  2-1)  that  is  assumed  to  describe  the  system  in  (2-1): 


^k*l\k  -  ^k^k\k 

(2-13) 

^k*l\k  =  ^k^k\k^l  Qk 

Equations  (2-10)  to  (2-13),  together  with  the  assumptions  (2-5)  and  (2-6)  and  initial  conditions 
(2-7)  form  the  basic  Kalman  filter  algorithm. 


2.4  EXTENDED  KALMAN  FILTER 


As  was  mentioned  before,  there  are  many  variations  of  the  basic  filter.  A  version  of  the 
Extended  Kalman  Filter  (EKF),  will  be  outlined  in  this  section. 
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Consider  the  case  when  the  measurements  are  nonlinear  functions  of  the  state  vector 


(2-14) 


where  can  be  a  general  nonlinear  vector  function  of  Such  a  system  description  is  very 
common  in  target  tracking  systems.  For  example,  since  the  target  is  often  modelled  in  an  x-y-z 
Cartesian  coordinate  frame  and  the  sensor  is  often  a  range-angle-angle  measuring  radar,  a 
nonlinear  coordinate  transformation  is  required  between  the  state  and  measurement  equations. 

It  can  be  shown  that  a  very  close  approximation  to  the  optimal  Kalman  filter  can  be 
obtained  when  this  non-linear  function,  Is  linearized  around  the  current  value  of  the  state 
estimate;  that  is,  the  matrix  is  computed  by  differentiating  *^(x)  with  respect  to  the 

vector  X  and  evaluating  the  result  at  the  current  value  of  •^*|*-i* 


^k(^k\k-l) 


Bh^ix) 

dx 


(2-15) 


where  differentiation  of  one  vector  with  respect  to  another  is  defined  in  the  standard  way  as 


Bm 

3x 


BX: 


where  the  subscripts  here  denote  the  corresponding  vector  and  matrix  elements.  This  adds  only 
a  small  amount  of  extra  computation  to  the  filter  and  is  fairly  simple  to  implement.  The  Kalman 
filter  update  equations  change  slightly;  Equations  (2-10)  to  (2-12)  become: 
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The  propagate  stage,  (2-13),  remains  unchanged  for  the  Extended  Kalman  filter: 


2.5  AN  EXAMPLE:  A  SINGLE  AXIS  INTEGRATED  NAVIGATION  SYSTEM 


A  simplified,  one-dimensional  navigation  example  will  be  described  here  to  show  the 
principles  of  designing  a  Kalman  filter  for  a  multi-sensor  integrated  system  that  provides  a  more 
accurate  and  reliable  solution  than  if  the  sensors  were  used  individually.  Modem  navigation 
systems  often  consist  of  several  independent  sensors,  all  giving  measurements  related  to  position, 
velocity  or  heading  that  the  navigator  must  assemble  into  a  reasonable  estimate  of  his  true 
situation.  The  Kalman  filter  has  been  successfully  applied  to  automate  this  process.  A  large 
system  may  have  one  or  more  inertial  navigation  systems  (INS’s),  a  Global  Positioning  System 
(GPS)  receiver,  other  receivers  for  land-based  radio  wave  systems  such  as  Loran-C  and  Omega, 
a  velocity  sensor  (water  speed  log,  air  speed  data,  doppler  velocity,  or  odometer  for  example), 
heading  sensors  (magnetic  compass,  gyrocompass),  height  sensor  (barometric  altimeter,  radar 
altimeter),  or  a  number  of  others.  (See  McMillan  (1987)  for  details  of  such  a  navigation  system 
as  applied  to  arctic  land  vehicles.)  A  full  Kalman  filter  is  quite  complex,  often  estimating  as 
many  as  50  or  60  state  variables  from  10  to  20  measurements. 

Consider  the  much  simplified  problem  of  integrating  two  sensors  (an  INS  and  a  GPS  set) 
to  estimate  position  p  in  one  direction,  say  latitude  (similar  to  Example  4.2-4  of  Gelb  (1974)). 
In  most  navigation  applications,  the  filter  does  not  estimate  the  position,  per  se,  but  rather  the 
error  in  the  position  as  reported  by  the  INS.  This  is  because  these  errors  can  be  very  accurately 
modelled  in  terms  of  linear  stochastic  processes,  whereas  the  position  itself  is  dominated  by  non- 
random  control  input  (from  the  vehicle  operator)  which  cannot  be  so  accurately  modelled.  Also, 
if  the  aiding  sensor  becomes  unavailable,  the  filter  will  still  be  providing  corrected  INS  position 
outputs,  even  though  the  filter  estimates  of  the  errors  will  slowly  degrade  (a  fail-operational 
system). 

Our  simple  model  of  the  single  axis  INS  will  be  an  accelerometer  with  an  output  a(r),  that 
is  integrated  to  give  speed  s(r),  and  then  again  to  give  position  p(r): 


12 


pit)  =  ^s{x)(h 
sit)  =  J^a(T)dT 

However,  the  accelerometer  has  an  unknown  but  constant  bias  error,  b,  that  is  being  twice 
integrated  so  that  the  indicated  position  has  an  error  that  is  growing  as  P'.  The  Kalman  filter  will 
try  to  estimate  this  error  so  that  it  can  be  removed.  The  INS  error  states  modelled  in  the  filter 
are  INS  position  error  bp,  INS  speed  error  bs,  and  INS  accelerometer  error  ba.  The  relations 
between  the  states  are 

4.bpit)  =  bpit)  =  bsit) 
dt 

^bsit)  =  5i(t)  =  bait)  (=  b,  the  unknown  bias) 
dt 

—bait)  =  bait)  =  0 
dt 

which  can  be  written  in  matrix  form  as 


bpit) 

0  1 

0 

8pit) 

m) 

0  0 

1 

bsit) 

bait)_ 

P  0 

0. 

bait)_ 

Note  that  this  is  in  the  form  of  the  continuous  time  system  of  Eq.  (2-2)  with  =  0.  This  system 
can  be  discretized,  at  a  sampling  interval  of  AT  =  tj^+j'tj^,  via  (2-3)  to  get  the  state  transition 
matrix  If  we  define  F  as 


F  := 


0  1  0 
*0  0  1 
|o  0  0 


then 


<D^  =  =  /  +  FAT  + 


F^AT^ 

2! 


F^AT^ 

3! 


+  ... 


0  1  AT 
0  0  1 
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so  the  discrete  system  corresponding  to  (2-1)  is 


Sp 

5s 


5a 


k*l 


1  AT 

0  1 
0  0 


2 

AT 

1 


+  0 


or,  by  making  the  appropriate  association  of  notation, 

=  ^k^k  +  0 


(2-20) 


The  measurement  for  this  example  will  be  the  difference  between  the  indicated  positions 
of  the  GPS  set  and  the  INS: 


=  p*(GPS)  -  Pi^ilNS)  (2-21) 

The  measurement  from  the  INS  consists  of  the  true  position  plus  the  INS  position  error 

PicilNS)  =  pjt  +  ^Pk 

and  the  measurement  from  the  GPS  will  modelled  as  the  true  position  plus  the  GPS  position 
error,  which  we  call  Vj^: 


p^iGPS)  ^Pk^y>k 


Thus  the  measurement  equation  (2-21)  becomes 

z.  =  V.  -  5p, 


=  [-1  0  0] 


5p 

5s 

5a 


+  V, 


=  Hx^  + 


which  is  in  the  form  required  in  (2-4)  with  //  :=  (-1  0  0].  The  GPS  positioning  error  will  be 
modelled  as  an  uncorrelated  Gaussian  random  noise  sequence  that  satisfies  (2-5)  with  covariance 


E  {v^v^} 
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All  that  remains  in  the  filter  design  is  to  specify  the  initial  conditions  on  the  state  vector, 
iQ|_j ,  and  the  state  covariance  matrix,  .  As  is  usual,  the  initial  state  estimate  is  set  to  zero, 
and  the  initial  covariance  estimate  is  chosen  as  some  physically  reasonable  estimate  of  the  error 
variance: 

hpl  0  0 

/’oi-i  =  0  54  0 

0  0  8do 

The  specification  of  the  Kalman  filter  matrices  for  this  simplified  system  is  complete.  Just 
to  complete  the  design,  some  numerical  values  such  as  those  shown  below  can  be  specified; 

^GPS  ~  (^00 

ZPI  =  (1000  /n)2 

8^0  =  (10  mis? 

8do  =  (1  mlsh^ 

That  is  the  essence  of  the  procedure  involved  in  Kalman  filter  design.  There  are  many 
complications  to  this  in  most  real  systems.  For  example,  the  state  process  noise,  w^,  is  seldom 
assumed  to  be  zero  as  this  can  cause  the  filter  gains  to  go  to  zero  and  the  filter  essentially  stops 
operating.  The  numerical  values  of  the  noise  parameters  are  chosen  after  careful  analysis, 
simulation  and  testing  on  real  data  to  achieve  satisfactory  performance.  The  state  dynamics  and 
measurement  matrices  (d>j^,  H)  are  generally  much  more  complex  and  various  precautions  must 
be  taken  to  ensure  numerical  stability  and  to  safeguard  against  invalid  measurements.  The 
sequence  of  operations  can  also  be  more  complex  since  all  aiding  measurements  are  seldom 
available  in  such  a  synchronous  fashion. 
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3.0  TRACKING  AND  TRAJECTORY  PREDICTION 


3.1  INTRODUCTION 


This  chapter  summarizes  the  design  of  a  simulation  system  that  was  used  to  evaluate 
various  Kalman  tracking  filter  configurations  that  could  enable  land  platforms  to  track  and  engage 
multiple  maneuvering  targets,  either  passively  or  actively.  Typically  a  direct-fire  support  vehicle 
(DFSV)  acquires  and  must  track  multiple  targets  with  a  passive,  2-dimensional  imaging  sensor 
such  as  a  TV  or  infrared  camera.  When  a  particular  target  is  chosen  to  be  engaged,  an  active 
sensor,  such  as  a  laser  range  finder,  radar,  or  laser  radar,  would  be  used  to  obtain  range  and 
possibly  range-rate  information.  In  most  current  generation  vehicles,  a  laser  range  finder  is  used 
to  obtain  one  range  measurement  just  prior  to  firing  that  is  used  to  calculate  the  elevation  and 
azimuth  lead  angles  using  two  decoupled,  second-order,  constant  angular  rate  filters.  Target 
trajectory  prediction  can  be  improved  substantially  if  a  fully  coupled  3-dimensional  Kalman  filter 
tracking  algorithm  is  used  especially  if  range  is  measured  for  even  a  few  scans. 


3.2  TARGET  MODELLING 


This  section  looks  at  some  of  the  typical  coordinate  firames,  the  transformations  between 
them  and  the  structure  of  some  target  dynamics  models  that  can  be  used. 


3.2.1  Coordinate  Frames  and  Transformations 


A  point  in  three  dimensional  space  can  be  specified  in  a  variety  of  ways  but  usually  in 
either  rectangular  or  spherical  coordinates.  As  was  mentioned  Section  2.4,  the  sensor  of  a 
tracking  system  is  usually  most  naturally  represented  in  a  spherical  frame  but  the  target  knows 
nothing  about  the  sensor  frame  and  is  more  naturally  modelled  in  rectangular  coordinates,  since 
it  is  more  likely  to  travel  in  a  straight  line  than  it  is  to  move  along  the  surface  of  a  sphere. 

Consider  the  coordinate  frames  shown  in  Fig.  3-1.  The  principle  rectangular  frame  is 
defined  by  the  Xq-Yq-Zq  axes  which  are  aligned  with  the  locd  geographic  North,  East  and 
Down  directions  with  the  origin  at  the  sensor  location.  The  target  at  point  p  can  be  described 
in  rectangular  coordinates  at  the  point  spherical  coordinates  at  (r,b,e)  where 

b  is  the  bearing  angle  from  Xq  (North),  e  is  the  elevation  angle  above  the  horizon,  and  r  is  the 
distance  or  range  from  the  sensor  location  at  the  origin.  The  other  rectangular  frame  shown  as 
Xl-Y^-Zl  is  called  the  line-of-sight-to-target  frame  and  is  obtained  by  rotating  the  geographic 
frame,  first  about  the  Zq  axis  through  an  angle  b  and  then  elevating  it  (rotating  about  the  new 
Yq  axis)  by  the  angle  e.  It  has  the  same  origin  as  the  geographic  frame,  although  it  is  shown 
separated  to  reduce  the  clutter  on  the  diagram.  The  line-of-sight  frame  is  called  such  because 
the  x-axis  of  the  frame  always  points  directly  to  the  target. 
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Fig.  3-1:  Target  Coordinate  Frames 

Vectors  in  the  geographic  frame  can  be  expressed  in  the  line-of-sight  frame  by 


Px, 

Py, 

cose  cosb  cose  sinb  -sine 

-sinb  cosb  0 

PXc 

pya 

-.  L.Q 

pyo 

sine  cosb  sine  sind  cose 

PZc 

P2c 

where  C(^  is  the  Direction  Cosine  Matrix  (DCM)  that  converts  a  vector  expressed  in  G 
coordinates  to  one  expressed  in  L  coordinates.  Similarly  the  inverse  transformation  is 


Pxc 

Pya 

cose  cos 6  -sinb  sine  cosb 

cose  sinb  cosb  sine  sinf? 

Px, 

Py, 

- 

Px, 

Py, 

1 

u 

-sine  0  cose 

PZl 
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To  simplify  notation  slightly,  let  denote  an  arbitrary  3-dimensional  vector  that  is  expressed 
in  G  coordinates.  Then  we  simply  write 


p(°)  =  cf  p<« 


The  bearing  and  elevation  angles  can  be  expressed  in  terms  of  the  geographic  coordinates  as 


r 


2 

PXr 


b  =  \SiXi~\pxJpY^) 
e  =  sin‘^(-p2^/^) 


(3-3) 


and  similarly  the  reverse  is 


PXq  -  ''  cose  cosb 


Py^  -  r  cose  smb  .  (3-4) 


PZg  =  -'•sine 


Since  the  target  is  moving  relative  to  the  sensor,  the  line-of-sight  frame  is  rotating  with  respect 
to  the  geographic  frame.  The  rate  of  rotation  of  the  L  frame  with  respect  to  the  G  frame  will 
be  denoted  as  ^uq  and  can  be  written  in  L  frame  coordinates  as 


0) 


(£-) 

LIG 


=  b  «?>  .  e  uV 


L  /  (^)  (L)  .  ,  .  (L) 

=  b  («2^  cose  -  sme)  +  e 


-b  sine 
e 

bcose 


Ki') 


(3-5) 


where  denotes  a  unit  vector  in  the  direction  v,  b  is  the  bearing  slewing  rate  and  e  is  the 
elevation  slew  rate.  The  Coriolus  equation  can  be  used  to  transform  velocities  in  a  rotating  frame 
to  a  non-rotating  frame:  the  rate  of  change  of  a  vector  p  in  the  rotating  frame  as  seen  from  the 
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nonrotating  frame  is  known  to  be  {e.g.  Goldstein  (1950)  p.  133) 


)a  {‘^)l 

where  the  notation  (.)q  denotes  the  coordinate  frame  from  which  the  vector  is  being  viewed. 
Expressing  all  vectors  of  (3-6)  in  the  same,  say  L,  coordinates  and  defining  velocity  as 


(3-7) 


so  that  by  substituting  these  in  the  Coriolus  equation,  we  get  the  velocity  vector  of  p  as  seen 
from  the  non-rotating  G  frame  (though  it  is  still  coordinatized  in  L  coordinates): 


The  appropriate  DCM  can  be  used  to  convert  these  velocities  as  seen  in  the  G  frame  from  L  to 
G  coordinates  via 
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Equation  (3-8)  can  be  inverted  so  that  the  angular  rates  are  obtained  from  the  velocities: 

J  Vy 

i,  =  Vy^/(rcose)  (3-9) 

[  -%/'■ 

Similarly  the  Giriolus  equation  can  be  used  to  derive  accelerations  as  seen  in  rotating 
coordinate  frames: 


+  2o)^jjX 

L 


dt 


xp  +  (Huc^idipQXp) 

G 
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and  then  choosing  the  L  frame  to  coordinitize  all  vectors  and  defining  acceleration  as 


a  := 


dt^ 


(3-10) 


)G 


yields 


% 

“z. 


dr 


dt^ 


)L 


( 


The  angular  acceleration  of  the  rotating  coordinate  frume  can  be  found  by 


dm 


UG 


dt 


£ 

dt\ 


-bsine 

bcoie 


-bsing-i^cose 

e 

bcose-btsme 


IG) 


so  substituting  the  individual  L  frame  components  of  this  into  (3-11)  yields 


V 

Vi 

ff'] 

(  • 

-bsine 

fO 

= 

0 

+  2 

i 

X 

0 

\ 

J)Cose  ^ 

V 

-bsine  -  bicose 
e 

bcose  -  bisine 


0 

kOj 


f  .  ^ 

-bsine 

i 

bcose j 


r 


-bsine 

i 

bcose 


^  rA 


0 

vPyj 

(3-12) 


f  -  ri^  -  rb^ cos^e 
2rbcose  +  rbcose  -  Irbisine 

»  o 

-If-i  -  re  -  rb  cose  sine 


and  finally,  the  DCM  can  be  used  to  convert  the  accelerations  as  viewed  from  the  G  frame  to 
coordinates  in  that  frame: 


Xi) 


1 

JL 

{G) 

Gy 

= 

Cly 

- 

1 _ 

Again,  Eq.  (3-12)  can  be  inverted  to  find  the  accelerations  as  seen  by  the  tracking  system: 


(  \ 
f 

b 


+  re^  +  rb^co^e 


-  iLb  +  ibetane 


rcose 


"^2  f-  .  n 

- i  -  iLt  -  fr^cosesine 


(3-13) 


3.22  Target  Dynamical  Models 

The  mathematical  model  used  to  describe  the  motion  of  the  target  is  of  course  dependent 
on  the  type  of  target  Tracking  an  evasive  target  through  frequent  obscurations  requires  a  much 
different  model  than  that  used  for  a  cooperative  one.  A  good  selection  of  common  target  models 
is  summarized  in  Bogler  (1990),  Chapter  9.  There  are  roughly  4  main  categories  of  generic 
models  that  are  used.  Following  the  nomenclature  of  Fitzgerald  (1981)  these  are: 

1.  Random  Walk  Velocity  (RWV) 

2.  Exponentially  Correlated  Velocity  (ECV) 

3.  Random  Walk  Acceleration  (RWA) 

4.  Exponentially  Correlated  Acceleration  (ECV) 

Each  of  these  models  could  be  used  in  either  rectangular  or  spherical  coordinates.  Listed  below 
are  the  full  state  dynamics  equations  that  can  be  used  for  each  of  these  models  in  each  coordinate 
frame  (r  -  rectangular,  s  -  spherical). 

Rl.  Random  Walk  Velocity:  rectangular  (RWV(r)): 


£ 

dt\ 


PXc 

1“ 

Pro 

Vy 

^G 

P^G 

Vz 

^G 

% 

% 

^G 

• 

Vy 

ay 

^G 

Vz 

Gy 

1 

_  - 

0 

P^G 

0 

P^G 

0 

PZg 

Vy 

^G 

Vy 

^G 

^^YG 

Vz 

. 

(3-14) 


where  w  are  the  uncorrelated  white  noise  processes  representing  the  acceleration  components. 
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R2.  Exponentially  Correlated  Velocity:  rectangular  (ECV(r)'): 


PXa 

Vy 

PYg 

Vy 

d 

PZa 

% 

dt 

Vy 

-*C 

Vy 

Yq 

ay 

Vy 

. 

^7 

0  0  0  1 

0  0  0  0 

0  0  0  0 

0  0  0  -p,, 
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0 

1 

0 

0 

0 


0 

0 

1 

0 

0 

-Pv 


- 

r  ^ 

0 

PXg 

0 

PYg 

V/ 

0 

PZg 

Vy 

-*G 

*t* 

^f*XG 

''I'G 

^oyg 

-• 

(3-15) 


where  the  P  terms  define  the  coirelation  times  of  the  Markoy  processes  (as  described  in  Gelb 
(1974))  representing  the  acceleration  components. 


R3.  Random  Walk  Acceleration;  rectangular  (RWA(r)); 


dt\ 
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Yq 
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(3-16) 


where  j  denotes  "jerk"  or  the  rate  of  change  of  acceleration. 
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S2.  Exponentiallv  Correlated  Velocity:  spherical  (ECV(s 


S3.  Random  Walk  Acceleration:  spherical  (RWAfs)"): 
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S4.  ExT)onentiallv  Correlated  AccelCTation:  spherical  (ECAfsll: 
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3.3  MEASUREMENT  MODELS 


(3-20) 


(3-21) 


Target  measurements  are  almost  always  given  in  spherical  coordinates  as  bearing  and 
elevation  angles  (relative  to  some  known  reference  frame)  and,  if  available,  a  range  from  the 
sensor  to  the  target.  We  will  denote  the  measurement  vector  as  z: 
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These  measuiements  will  be  assumed  to  consist  of  the  true  values  of  the  quantities  being 
measured  plus  random  white  noise  con^onents,  v,  consistent  with  the  standard  Kalman  tilter 
measurement  model  equation,  (2-4): 


For  a  state  vector  in  spherical  coordinates,  the  map  between  the  measurement  and  state  is  linear 
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(3-22) 


but  for  a  state  vector  in  rectangular  coordinates,  the  relationship  is  nonlinear: 


= 

Kix) 

+ 

Zr 

hrix) 

where  the  nonlinear  functions  are  as  in  (3-3): 


/t^(x)  =  tan 


r  ^ 


V  ° ) 


hg{x)  =  sin 


-1 


~PZr 


hM)  =  ^  +  Pro  Pzc 


(3-23) 


(3-24) 


For  use  in  an  Extended  Kalman  filter,  this  nonlinear  measurement  vector  will  be  linearized 
about  the  state  vector  estimate  i  =  p^^  according  to  (2-15): 
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which,  after  one  has  taken  the  derivatives,  becomes 
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where 


^  •=  \jpXa  +  PyJ'  +  Pzc 


^  -  pXo  +  Pyq 


3.4  CHOICE  OF  TARGET  MODEL 


(3-25) 


(3-26) 


There  has  been  a  tremendous  amount  of  literature  arguing  the  various  merits  and 
shortcomings  of  each  of  these  models.  Countless  variations,  combinations  and  extensions  have 
been  proposed,  studied,  simulated,  tested  and  implemented.  A  number  of  adaptive  schemes  that 
switch  between  models  or  combine  outputs  of  parallel  models  also  exist  Relatively  recent  survey 
papers  include  Woolfson  (1985),  Chang  and  Tabaczynsld  (1984)  and  the  texts  of  Blackman 
(1986),  Farina  and  Studer  (1985)  and  others  are  all  invaluable  sources.  One  early  reference, 
Burke  et  al.  (1976),  used  random  walk  acceleration  models  to  track  a  maneuvering  tank  in  both 
geographic  and  line-of-sight  coordinates.  New  refinements,  such  as  Rouhi  and  Farooq  (1989), 
appear  continuously. 

The  choice  of  target  model  can  best  be  done  when  the  specific  scenario  is  known  and  some 
real  data  is  available  to  evaluate  the  various  models.  A  good  tracking  simulator  will  allow 
different  models  to  be  tested  and  evaluated  so  that  a  suitable  one  (or  more)  is  chosen  for  the 
purpose  at  hand.  The  next  two  chapters  describe  a  simulator  that  was  developed  for  potential  fire 
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control  systems.  It  can  inclement  any  of  the  above  models  and  it  has  some  interesting  features 
that  may  be  particularly  useful  for  land  fire  control  Developing  a  flexible  simulation  package, 
rather  than  extensive  model  evaluation,  was  the  primary  goal  of  the  effort 

There  are  a  few  rules  of  thumb  that  assist  in  the  choice  of  a  model.  In  general,  the 
inclusion  of  acceleration  states  makes  a  filter  more  able  to  track  sudden  maneuvers  but  at  the 
expense  of  a  noisier  estimate  when  the  target  is  not  accelerating.  On  the  other  hand,  the 
exclusion  of  acceleration  states  will  make  the  filter  estimate  more  accurate  when  the  target  is  not 
maneuvering  but  a  sudden  target  acceleration  may  cause  the  filter  to  loose  the  target  The 
amount  of  noise,  w,  that  is  assumed  to  enter  the  state  model  can  have  a  similar  effect:  the  larger 
its  covariance,  the  noisier  but  more  responsive  the  filter,  the  smaller  the  Qj^  the  quieter  but 
more  sluggish  the  filter.  In  general,  one  often  sees  high  Q  uncorrelated  acceleration  filters  for 
tracking  highly  maneuverable  targets  such  as  fighter  aircraft,  and  low  Q  correlated  velocity  filters 
for  tracking  ships  and  submarines.  Land  combat  vehicles  would  fall  somewhere  in  between.  For 
this  study,  moderate  Q  values  were  used  with  both  velocity  and  acceleration  models. 
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4.0  TRACKING  FILTER  SIMULATIONS 


This  chapter  presents  some  results  from  the  simulation  program  that  was  developed  to  test 
the  various  Kalman  filter  based  tracking  algorithms  presented  in  the  previous  chapter.  The 
software  was  written  in  "C"  and  is  very  generic.  The  initial  Kalman  filter  matrices  and 
parameters  are  read  in  from  files  as  is  the  simulated  sensor  data.  Only  a  few  routines  exploit 
certain  features  or  ordering  of  the  state  vector  elements  and  these  were  grouped  together  to 
remind  the  developer  which  routines  might  have  to  be  modified  if  a  different  state  vector 
formulation  was  used. 


4.1  DATA  GENERATION 

4.1.1  Truth  Data  Generation 

A  pre-existing  program  (TGen)  was  used  to  generate  the  truth  data  for  the  target 
trajectories.  Through  a  plain  language  input  text  file,  the  user  specifies  the  target’s  initial 
position,  velocity  and  heading  and  changes  to  these  values  at  any  subsequent  point  in  time.  The 
program  computes  the  deterministic  position,  velocity,  acceleration,  attimde  and  attitude  rates  of 
the  target  and  saves  these  in  a  data  file. 

4.12  Sensor  Data  Generation 

A  simple  program  called  SensData  was  developed  that  would  take  the  data  files 
representing  the  true  target  trajectories  and  produce  simulated  bearing,  elevation  and,  if  requested, 
range  measurements  as  might  be  produced  by  a  generic  imaging  sensor  system.  The  program 
allows  pseudorandom  noise  to  be  added  to  tiie  true  bearing,  elevation  and  ranges,  permits  the 
turning  on  and  off  of  ranging  information  to  simulate  passive  to  active  mode  switching,  and  can 
simulate  target  obscuration  by  removing  sensor  data  for  arbitrary  intervals.  If  there  is  more  than 
one  target,  it  will  merge  the  sensor  data  associated  with  all  targets  into  one  file  and  sort  by  time 
stamp.  It  can  also  simulate  clutter  by  generating  false  targets  at  any  specified  probability  of  false 
alarm. 

Shown  in  Fig.  4-1  below  (and  in  x-y  form  as  Target  1  in  Fig.  5-1)  is  a  simulated  trajectory 
of  a  land  target  moving  at  a  constant  speed  of  15.0  m/s  (  =  54.0  km/hr)  at  a  range  of  initially 
1500m.  It  recedes  from  the  sensor  for  8  seconds,  makes  a  90  degree  right-hand  turn  (at  ^=8s, 
duration  5  seconds),  travels  across  the  sensor  field  of  view  for  another  4  seconds,  then  makes 
another  right  hand  turn  (at  r5=17s,  duration  5s)  and  travels  toward  the  sensor  for  the  final  3 
seconds.  The  figure  shows  the  true  range,  bearing  and  elevation  to  the  target  as  well  as  the  noisy 
measurements  of  these  quantities  made  by  the  sensor  at  0.1s  intervals.  The  measureme  ts  arc 
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Sensor  data  •  Ground  target  at  1 600  m 
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Fig.  4>1:  Simulated  sensor  data  for  a  ground  target  at  1600m,  first  leceeding,  then  crossing, 

then  closing  on  sensor  location.  Both  truth  and  noisy  data  are  shown. 


where  the  covariance  values  of  the  measurement  noises  are 


R(k)  =  E 


[  Vj,(k)  v,(k)  v^ik)  Y  = 

(0.00175  rad)^ 

0 

0 

v,(*) 

/h\ 

0 

(0.00175  rad)^ 

0 

0 

0 

■ - 1 
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4.2  TRACKING  FILTER  RESULTS 


This  section  shows  some  representative  results  of  typical  simulations.  The  purpose  is  not 
necessarily  to  show  the  best  tracking  filter  for  the  simulated  trajectory  but  rather  to  show  some 
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of  the  features  that  are  available  in  the  simulator.  Again  the  choice  of  the  "best"  filter  depends 
on  the  application.  In  this  chapter  we  assume  that  the  range  information  is  either  available  for 
the  entire  trajectory,  or  unavailable  for  the  entire  trajectory.  The  next  chapter  describes  a  method 
to  handle  the  case  when  range  data  is  intermittendy  available  and  presents  some  simulated  results 
of  such  a  situation. 

The  Kalman  dlter  program,  called  "tracker",  was  written  iri  c.  It  accepts  a  configuration 
file  with  various  control  parameters,  as  well  as  the  continuous  time  state  dynamics  matrix,  F,  and 
power  spectral  density  matrix,  Q^.  It  also  reads  in  the  assumed  level  of  measurement  noise,  i.e., 
the  R  matrix  and  the  names  of  the  sensor  data  file  and  the  truth  data  Hie.  It  produces  output  files 
for  the  values  of  the  states,  the  state  errors,  and  residuals,  as  well  as  the  square  roots  of  the 
corresponding  diagonals  of  the  covariance  matrix.  The  program  first  does  a  discretization  of  the 
continuous  time  matrices,  and  thereafter  operates  as  a  discrete  EKF. 


4.2.1  Random  Walk  Velocity  (RWV(r))  Model  •  Range  Available 


In  -ais  case,  range  information  is  available  and  the  RWV(r)  model,  Eq.  (3-14),  is  used. 
This  is  a  3  dimensional  rectangular  coordinate  frame  model.  The  measurement  equation  is  the 
nonlinear  form  of  (3-23)  so  the  extended  Kalman  filter  formulation  is  used.  The  power  spectral 
density  matrix  of  the  state  process  noise  required  for  the  discretization  equations  (2-3)  is 
estimated  in  Appendix  A  where  it  is  shown  to  be 
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Shown  in  Fig.  4-2  below  are  the  errors  in  the  state  estimates  of  each  cartesian  position 
coordinate  as  well  as  the  filter  estimates  of  the  square  root  of  the  covariance  of  that  estimate,  i.e., 

x^iklk)  =  x^ik)  -  ij(,k/k)  and  ^P^fjdk)  where  the  subscript  refers  to  an  individual  element.  As 
well,  the  velocity  state  estimation  errors  and  covariance  elements  are  shown  in  Fig.  4-3.  The 
measurement  residuals,  Viikjk)  =  zfjk)  -  h^(.£iklk))  as  well  as  the  square  root  of  the  filter 

estimated  residual  covariance,  {[H(k)P(k/k)H(kf]ii  +  /?„(^)}^^,  arc  shown  in  Fig.  4-4. 


The  state  estimate  errors  for  the  most  pan  lie  within  their  expected  standard  deviation, 
indicating  a  reasonably  well-tuned  filter.  The  target  right  hand  uims  during  r=8  to  r=13  and  r=17 
to  t=22  cause  larger  state  errors  to  occur  during  the  maneuvers  and  they  disappear  after  the 
maneuver  is  completed.  The  smaller  Q  value  for  the  vertical  velocity  state  shows  up  in  the 
figures  as  smaller  state  estimation  errors  and  covariances  for  both  the  vertical  position  and 
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velocity.  This  shows  the  type  of  tradeoff  one  expects  as  Q  varies. 
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Fig.  4-4:  RWV(r)  model.  Measurement  residuals  and  covariance  matrix  elements. 


4.22  Random  Walk  Velocity  (RWV(s))  Model  -  Range  Unavailable 

When  range  information  is  unavailable  a  spherical  coordinate  velocity  model  similar  to  Eq. 
(3-18)  is  used.  The  range  states  are  deleted  so  we  are  left  with  the  4  state  filter: 
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The  measurement  equation  is  now  a  linear  function  of  the  states  so  an  extended  Kalman  filter 
formulation  is  not  required.  The  power  spectral  density  matrix  of  the  state  process  noise  required 
for  the  discretization  equations  (2-3)  is  taken  as  (again,  see  Appendix  A) 
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The  results  of  this  "angle  only"  filter  are  shown  in  the  following  figures.  First  the  angular 
position  state  errors  and  their  estimated  covariances  are  in  Fig.  4-S,  and  the  angular  velocity  state 
errors  and  associated  estimated  covariances  are  shown  in  Fig.  4-6.  For  completeness  the 
measurement  residuals  are  shown  in  Fig.  4-7. 


Fig.  4-5:  RWV(s)  model.  Angle  state  estimation  errors  and  covariance  matrix  elements. 
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Fig.  4-6:  RWV(s)  model.  Angular  rate  state  estimation  errors  and  covariances. 
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Fig.  4-7:  RWV(s)  model.  Measurement  residuals  and  covariance  matrix  elements. 


With  the  relatively  large  noise  (1.75  mrad)  that  was  superimposed  on  the  bearing  and 
elevation  measurements,  the  filters  are  performing  about  as  well  as  could  be  expected.  Again 
the  target  maneuvers  starting  at  t=S  and  r=17  produce  brief  biases  in  the  errors  of  estimates  of 
both  the  bearing  and  bearing  rate  states.  Any  number  of  maneuver  detectors  (e.g.  Woolfson 
(1985))  are  available  for  this  problem  but  none  are  included  in  the  simulations  to  date.  A  look 
at  the  bearing  residual  Fig.  4^7  shows  very  little  effect  of  the  maneuvers  because  of  the  high 
measurement  noise  used  in  these  examples. 


4.3  DISCUSSION 


The  simulation  results  presented  here  should  be  taken  only  as  examples  of  scenarios  that 
may  or  may  not  be  particularly  realistic.  With  the  simulation  tools  as  they  exist  now,  it  is  easy 
to  rapidly  prototype  various  filter  configurations  and  evaluate  their  performance  against  real  target 
measurement  data  from  specific  imaging  sensors.  What  is  satisfactory  for  one  type  of  sensor  may 
not  be  so  for  another.  For  example,  a  maneuver  detector  based  on  filler  residuals  may  work  well 
for  a  relatively  low  noise  sensor,  but  may  not  if  the  sensor  generates  position  data  as  noisy  as 
was  used  in  the  previous  section.  Also,  the  next  chapter  outlines  a  multi-target  algorithm  that 
uses  filter  residuals  to  determine  which  measurement  to  associate  with  which  track.  In  that  case, 
most  maneuver  detectors  based  on  residuals  will  not  woric  particularly  well. 
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5.0  TRACKING  FILTER  ENHANCEMENTS 


This  chapter  outlines  a  few  enhancements  that  were  made  to  the  tracking  algmithms  of  the 
previous  chapter  that  may  make  them  more  applicable  to  direct-fire  support  applications.  These 
include  a  swapping  algorithm  that  allows  the  ^ter  to  swap  from  an  angle-only  filter  to  a  full  3 
dimensional  cartesian  coordinate  filter  when  an  active  range-finding  sensor  is  activated;  and  a 
simple  but  practical  multiple  target  tracking  algorithm  that  allows  the  fire  control  system  to 
maintain  lock  on  several  targets  in  the  field  of  view  while  another  target  is  being  engaged. 


5.1  MULTIPLE  TARGET  TRACKING 


When  a  target  is  to  be  tracked  in  a  cluttered  environment  (i.e.  one  with  potential  false 
targets)  or  when  more  than  one  target  must  be  tracked  simultaneously,  there  must  be  a  method 
in  the  algorithm  to  determine  which  track  a  particular  measurement  belongs  to,  or  if  it  is  a  false 
target  There  are  many  such  algorithms  available  in  the  literature  and  include  the  nearest 
neighbour  method,  the  probabilistic  data  association  method,  the  multiple  hypothesis  tracking 
method,  among  others,  all  of  which  are  summarized  in  Roy  (1990)  or  McMillan  and  Lim  (1990) 
or  described  in  more  detail  in  texts  such  as  Blackman  (1986)  or  Farina  and  Studer  (1985).  The 
simplest  of  these,  but  arguably  the  least  satisfactory  for  very  closely  spaced  targets,  is  the  nearest 
neighbour  method.  Nonetheless,  this  method  was  ui^lemented  and  found  to  perform  quite  well 
given  its  simplicity.  The  method  and  some  simulation  results  are  described  in  this  chapter. 


5.1.1  Nearest  Neighbour  Method 


The  nearest  neighbour  algorithm  first  finds  all  c  jnent  tracks  that  are  reasonably  close  to 
the  measurement  by  a  process  known  as  "gating”,  described  below.  If  there  are  none,  then  the 
data  is  either  a  new  target  or  a  piece  of  clutter.  In  either  case,  a  tentative  track  filter  is  initiated 
for  the  measurement  which  becomes  valid  only  if  there  are  subsequent  measurements  associated 
with  it.  If,  on  the  other  hand,  there  are  one  or  more  tracks  that  are  close,  then  simply  the  track 
that  is  the  closest  is  updated  with  that  measurement. 

To  make  the  notion  of  gating  more  precise,  define  a  normalized  "distance",  d,  from  the 
location  of  the  measurement  at  time  k,  z(k),  to  the  tracking  filter’s  prediction  of  the  measure¬ 
ment,  A(f(klk-1)),  for  each  track; 

d\kSk-\)  :=  [z{k)  -  h(i()tlk-l))f  [H{mk-\))Pm-l)H'^imk-l))  +  (5-1) 

[zik)  -  h(je(klk-l))] 


(The  notation  here  is  the  same  as  that  of  Chapter  2.)  Note  that  this  "distance"  is  essentially  the 
length  of  the  residual  vector,  normalized  by  its  estimated  covariance.  A  gate  threshold  must  be 
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specified,  to  which  d  is  compared  to  see  if  the  measurement  is  close  to  the  ^ter.  This  threshold 
is  typically  around  5.  The  nearest  neighbour  algorithm  can  be  summarized  as: 

1.  Obtain  the  new  measurement,  z(k). 

2.  Propagate  all  current  tracks  to  the  new  time  (i.e.,  compute  £(/dk-l),  P(k\k-1)). 

3.  Confute  d  as  in  (5-1)  for  each  track. 

4.  If  d  of  all  tracks  >  gate  threshold  then  initiate  a  new  tentative  track  filter. 

5.  Otherwise  update  the  track  having  the  minimum  d  with  the  measurement 

Tracks  can  be  deleted  if  they  are  not  updated  with  a  new  sensor  measurement  after  a  certain 
period  of  time  or  a  certain  number  of  scans. 


5.2  FILTER  SWAPPING  ALGORITHMS 


Typically  the  fire  control  system  searches  for  targets  in  a  passive  mode  with  an  optical  or 
infrared  imaging  sensor  and  tracks  these  targets  with  angle-only  filters.  When  a  target  is  to  be 
engaged,  an  active  ranging  sensor  is  turned  on  and  information  from  the  third  spatial  dimension 
becomes  available  to  the  tracking  filters.  It  would  be  preferred,  then,  to  use  one  of  the  cartesian 
coordinate  target  models  since  target  motions  are  more  naturally  described  in  cartesian 
coordinates.  If  for  some  reason  the  target  is  disengaged  but  still  is  to  be  tracked,  the  filters  will 
have  to  revert  to  a  passive,  angle-only  tracking  mode.  This  section  describes  a  method  that  can 
be  used  to  swap  a  2  (spatial)  dimensional  passive,  angle-only  tracking  filter  to  a  3  dimensional 
active,  cartesian  one  when  range  information  becomes  available  and  vice  versa  when  it  ceases. 


5.2.1  Passive  to  Active  Filter  Swap 


In  essence,  the  filter  swapping  techmque  uses  the  current  state  estimate  and  covariance 
matrix  to  initialize  another  Kalman  filter  that  uses  the  new  set  of  dynamical  equations.  To  swap 

from  an  angular  filter  (with  current  state  vector  [bib  i  b  e  ]^)  to  a  rectangular  one  (with 

a  new  state  vector  [  py^  p^^  ^Xq  ^Yq  ^Zq  ^Xq  ^Zq  when  a  valid  piece  of  range, 

range  rate  or  range  acceleration  (z^,  z^,  or  z^)  data  becomes  available,  the  following  steps  can 
be  initiated; 
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1.  Compute  the  Line-of-sight  to  Geographic  DCM,  ,  using  the  current  best  estimate 
of  bearing  and  elevation  available  from  the  filter: 


cos^  cosh  -sinh  sini  cosh 
cos^  sinh  cosh  sini  sin5 
-sini  0  cosi 


2.  Estimate  the  geographic  relative  position  vector  from  the  measured  range  and  filtered 
bearing  and  elevation: 


3.  Estimate  the  line-of-sight  relative  velocities  from  the  estimated  angular  rates  and  the 
measured  range  and  range  rates  (if  range  rate  not  available,  use  =  0): 
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4.  Convert  the  line-of-sight  velocities  to  geographic  velocities; 
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II 

1 

5.  Estimate  the  line-of-sight  accelerations  from  the  estimated  angular  accelerations  and 
the  measured  range  and  range  rates  (if  range  acceleration  not  available,  use  Zj,  =  0): 
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6.  Convert  the  line-of-sight  accelerations  to  geographic  accelerations: 
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The  corresponding  swapping  of  exact  covariance  matrix  information  would  be  very 
complex  (due  to  the  nonlinearity  of  the  coordinate  transformations)  and  of  minimal  value  since 
the  covariance  matrix  quickly  converges  to  its  steady  state  values.  The  following  is  an 
approximation  that  will  initialize  a  new  ^agonal  covariance  matrix  from  the  diagonals  of  the  old 
and  which  should  result  in  relatively  modest  covariance  element  transients  following  a  filter 
swap; 
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1.  Extract  the  square  roots  of  the  diagonals  of  the  existing  covariance  matrix: 


For  position  states: 
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For  velocity  states: 
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For  acceleration  states: 

:= 

.'1^. 

It  should  be  noted  that  a  passive  Elter  may  not  have  range  states  and  consequently  no 
corresponding  covariance  elements  ,  P^^) .  The  filter  obtains  estimates  for  these 

parameters  from  a  configuration  file. 

2.  Approximate  the  corresponding  L  ftame  standard  deviations  via: 
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(Compare  these  transformations  with  Eqn.  (3-8)  which  related  the  bearing,  elevation  and 
range  rates  to  the  velocites  in  L  coordinates.  Such  a  transformation  takes  the  components 
of  the  covariance  matrix  representing  the  uncertainty  in,  say,  the  angular  position  estimate 
(o^,  o^)  and  uses  the  measured  range  and  elevation  to  convert  these  to  rectangular 

coordinates.  The  uncertainty  in  range,  transforms  directly  to  since  the  axis 
points  along  the  range.  The  uncertainty  in  elevation,  o^,  multiplied  by  the  range  gives  the 
uncertainty  in  the  vertical  cartesian  direction  Z^.  Si^arly  for  the  bearing  and  the 
direction.  The  same  transformation  is  applied  to  the  angular  velocity  and  acceleration 
uncertainties.) 

3.  Convert  these  to  G  frame  coordinates  with  the  current  DCM: 


For  position  states: 


For  velocity  states: 
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For  acceleration  states: 
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4.  Initiate  the  covariance  matrix  as; 


:=  diag 
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S.2J2  Active  to  Passive  Filter  Swap 

When  the  system  loses  ranging  information  to  the  target,  the  filter  will  coast  through  a  few 
updates  using  the  predicted  range  measurement  as  new  data.  After  a  certain  number  of 
successive  updates  with  no  new  range  data,  the  filter  will  revert  to  a  bearing  and  elevation  angle 
tracker.  The  initial  conditions  for  the  new  filter  are  derived  from  the  last  state  and  covariance 
matrix  estimates  from  the  cartesian  filter  in  a  manner  similar  to  that  above.  To  obtain  the  new 

state  vector  [b  S  h  i  b  i  f  from  the  old  [  Py^  p^^  ^Zg 
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1.  Compute  the  Geographic  to  Line-of-sight  DCM,  Cq  ,  using  the  cuirent  best  estimate 
of  bearing  and  elevation  available  from  the  filter: 

b  :=  tan"^  ^yJPx,) 
i  :=  sin"^ 

A  A 

cose  cosb  cosi  sinb  -siai 
-Slab  cosb  0 
_sin^  cosh  sin^  sinh  cos^ 

2.  Convert  the  geographic  velocities  to  line-of-sight  velocities: 


iL) 

r  1 

■*G 

II 

- 

- 

.  ^0. 

3.  Estimate  the  angular  rates  from  the  line-of-sight  velocities: 


A 

r 

- 1 

A 

b 

= 

Uy  Kfcosi) 

A 

- 1 

1 

_ 1 

4.  Convert  the  geographic  accelerations  to  line-of-sight  accelerations: 


•  • 

[L) 

^X 

:= 

- 

~  '■'G 

dy 

*G 

- 1 

JO. 
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S.  Estimate  the  angular  accelerations  from  the  line-of-sight  accelerations: 


A 

r 

A 

A  ^  ^  A 

b 

= 

dy  /(f COS i)  -  2{rlf)b  +  2^  ^tan^ 

A 

A  A 

-d2  If  -  2(i‘lf)e  -  i)  cos 8 sini 

.  t. 

The  covariance  matrix  for  the  new  tilter  can  be  initiated  from: 

1.  Extract  the  square  roots  of  the  diagonals  of  the  existing  covariance  matrix: 


For  position  states: 


For  velocity  states: 


For  acceleration  states: 


p  * 

“  ■ 

^PXG 

^^PXG  PXG 

^PfG 

:= 

Pyg  Pyg 

^Pza_ 

_  Pza  PzG  _ 

f.  m 

O'v 

Jp 

''xc 

Y^xg  vxc 

^VyC- 

:= 

Pyg  ^yg 

''zc  ''zc_ 

^®xc 

/^®XC  ®xc 

;  = 

arc  aye 

)j^OzG  ^ZG  _ 
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2.  Convert  these  to  L  frame  coordinates  with  the  current  DCM: 


For  position  states: 


For  velocity  states: 


"  * 

iL) 

^PXL 

^Pxc 

^Pyl 

- 

- 

^Pyg 

^PZL_ 

^PZG_ 

r  1 

{L) 

-1 

- 

- 

^^YG 

.V 

KG) 


KG) 


For  acceleration  states: 


■ 

iL) 

■ 

^^YL 

II 

^<^yg 

<y„ 

c„ 

<^ZL 

KG) 


3.  Approximate  the  corresponding  spherical  frame  standard  deviations  via: 


1 - 

o 

o 

For  position  states: 

If 

PZL 

^PXG 

Gy^/(/’COS^) 

For  velocity  states: 

^•e 

s 

-V' 

5^ 

O 

O 

VmX' 

_ 1 

For  acceleration  states: 

ss 

^“xc 
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4.  Initiate  the  covariance  matrix  as: 


P  :=  diag  [a^^,  o/,  a/.  ...] 


5.3  SIMULATIONS  OF  ENHANCED  TRACKER  ALGORITHMS 


This  section  shows  some  numerical  results  of  the  filter  swapping  algorithms  described  in 
the  previous  sections.  Consider  the  trajectories  of  the  two  targets  shown  in  Fig.  5-1.  This 
represents  two  targets  about  20  m  apart  and  about  1600  m  from  the  sensor  moving  at  54.0  k^n/hr. 
Initially  they  are  travelling  away  from  the  sensor  but  then  turn  and  head  towards  the  sensor. 
Assume  passive  sensors  are  used  except  for  the  portions  of  the  trajectories  shown  in  the 
rectangles  (from  t=15  to  r=20  for  Target  1  and  from  ^=17  to  t=\9  for  Target  2)  when  a  ranging 
sensor  is  turned  on. 


5.3.1  Simulations  of  Filter  Swapping 


To  demonstrate  the  performance  of  the  filter  swapping  algorithms,  consider  only  a  single 
target  (Target  1  of  Fig.  5-1,  the  same  target  in  example  of  the  previous  chapter)  which  is  tracked 
with  a  4  state  bearing-elevation  angle  filter  for  15  seconds.  At  f=15  seconds,  valid  range 
measurements  are  available  for  the  next  5  seconds  and  then  ce^se  for  the  final  5  seconds  of  the 
engagement.  The  Kalman  filter  matrices  and  parameters  were  the  same  as  those  used  in  the 
previous  chapter.  Shown  in  Fig.  5-2  below  is  the  first  element  of  the  state  vector.  For  the  first 
15  seconds  and  the  final  5,  it  represents  the  filter  estimate  of  the  target  bearing  angle  in  radians. 
Between  r=15  and  r=20,  it  is  the  estimate  of  northerly  distance  to  the  target  in  meters. 

The  truth  data  for  these  are  shown  in  Fig.  5-3.  Since  the  scales  of  the  different  portions  of  the 
graph  are  not  compatible,  the  next  two  figures.  Fig.  5-4  and  Fig.  5-5,  show  the  distinct  regions 
of  interest.  The  corresponding  covariance  estimates  are  also  shown  in  Fig.  5-6  and  Fig.  5-7. 
Again  since  the  scales  of  the  different  segments  of  the  plots  are  not  compatible,  two  figures  are 
used. 
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Fig.  S-1:  True  x-y  trajectories  of  two  targets.  Ranging  information  is  assumed  to  be  available 
in  the  portions  of  the  trajectories  enclosed  by  rectangles. 
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Slitt  1  Btirtig  vigto 


Fig.  5-6:  Covariance  of  first  state  Fig.  5-7:  Covariance  of  first  state  {Xq 

(bearing)  when  range  is  not  position)  when  range  is 

available.  Notice  small  available  from  ^=15  to  /=20. 

transient  after  swap  at  r=20. 


The  covariance  of  the  p^q  state  in  Fig.  5-7  shows  some  initial  transients  after  it  was  formed 
when  range  became  available  at  r=15.  When  range  information  ceased  at  t=20,  the  cartesian  filter 
tried  to  coast  along  for  the  next  three  updates  (0.3s)  with  no  range  measurements  and 
consequently  the  covariance  estimates  started  to  diverge  rapidly  at  t=20.  The  filter  was  then 
swapped  back  to  the  bearing-elevation  filter  and  the  corresponding  covariance  element  became 
that  of  the  bearing  state  again,  Fig.  5-6,  after  some  brief  transients  after  r=20. 


5.3.2  Simulations  of  Multi-Target  Nearest  Neighbour  Tracking  With  Filter  Swapping 


The  simulation  system  previously  described  was  modified  to  include  the  nearest  neighbour 
multitarget  algorithm.  Sensor  data  files  of  closely  spaced  targets  were  generated  and  the  files 
were  merged  and  sorted  by  time  stamp  with  no  indication  as  to  which  target  generated  which 
return.  The  algorithm  associates  a  new  measurement  to  the  closest  existing  track  (if  there  is  one 
within  the  gate  threshold)  or  it  spawns  a  new  filter  for  a  measurement  lying  outside  all 
thresholds.  When  the  filters  were  properly  tuned,  the  algorithm  would  eventually  settle  on  one 
filter  for  each  target  with  only  the  occasional  misassociation.  Clutter  points  generated  at  random 
would  also  spawn  new  filters,  but  without  subsequent  measurements  being  associated  with  them, 
these  filters  would  quickly  die. 


48 


Fig.  5-8  below  shows  the  true  and  measured  bearings  to  the  two  targets  of  Fig.  5-1. 
Likewise  Fig.  5-9  shows  the  true  and  measured  elevations.  The  true  and  measured  ranges  shown 
in  Fig.  5-10  require  a  bit  of  explanation:  the  measured  range  is  negative  in  the  portions  of  the 
trajectory  when  the  ranging  sensor  is  turned  off.  That  is  how  the  simulator  distinguishes  between 
a  passive  and  an  active  sensor.  The  performance  of  the  nearest  neighbour  algorithm  is 
represented  in  the  top  chart  of  Fig.  5-11.  A  spike  in  the  plot  for  Filter  1,  for  example,  means  that 
it  was  incorrectly  updated  with  a  measurement  &om  target  2.  Fig.  5-12  shows  the  second  state 
variable  from  Filter  1  (which  is  the  elevation  state  when  it  was  a  bearing-elevation  angle  filter, 
and  is  the  east  position  state  when  it  is  swapped  to  a  cartesian  filter  at  /=15).  The  bottom  portion 
of  the  same  figure  shows  the  corresponding  state  error  and  its  covariance.  The  Kalman  filter 
matrices  and  parameters  remained  same  as  in  the  previous  example,  and  the  "gate  thresholds" 
were  chosen  as  6.0  for  a  cartesian  filter  and  4.5  for  a  bearing-elevation  filter.  Filter  1  is  spawned 
immediately  and  takes  all  the  measurements  from  both  targets  and  associates  them  with  the  same 
filter  for  the  first  2  seconds  or  so.  Eventually  the  filter  converges  sufficiently  to  recognize  there 
are  two  distinct  targets  and  spawns  a  new  filter  for  Target  2  at  about  r=2.  From  then  on,  the  two 
targets  are  distinguished  most  of  the  time,  with  occasional  misassociations  occurring  at  the  times 
of  the  spikes.  The  lower  graph  in  Fig.  5-11  represents  the  times  that  the  filters  were  swapped 
as  the  range  information  became  available  or  ceased:  Filter  1  was  swapped  from  a  BE  (bearing- 
elevation)  filter  to  an  XYZ  (cartesian)  filter  when  the  range  information  of  Target  1  was  valid 
from  t=l5  and  reverted  to  the  BE  filter  shortly  after  ^=20.  Likewise  for  Filter  2  when  the  range 
of  Target  2  was  available  from  r=17  to  r=19. 


Measured  Bearing  Angiss,  Targets  1  &  2 
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Fig.  5-8  Measured  and  true  bearing 
angles,  two  closely  spaced 
targets 
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Fig.  5-9  Measured  and  true  elevation 
angles,  two  targets 
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Measured  and  true  range,  two 
targets.  (Negative  range 
indicates  it  is  unavailable  to 
the  filter.) 


Fig.  5>11  Times  of  misassociations  (top 
figure)  and  times  of  filter 
swaps  (below). 


Filter  1,  state  2  estimate,  error  and  covariance 
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Elevation  state  estimate  from  Filter  1,  showing  misassociations  &  swap 


6.0  KALMAN  FILTERS  FOR  MUZZLE  REFERENCE  SYSTEMS 


6.1  INTRODUCTION 


This  chapter  describes  the  modelling  and  simulation  work  that  was  done  with  the  goal  of 
applying  Kalnian  filtering  to  a  dynamic  muzzle  referencing  system.  The  DMRS  hardware 
consists  of  a  small  laser  transceiver  mounted  on  or  near  the  mantlet  of  the  gun.  A  small  mirror 
is  noounted  on  the  muzzle  to  reflect  the  laser  beam  back  to  the  receiver.  As  the  barrel  flexes  due 
the  motion  of  the  vehicle  over  rough  ground,  the  angle  of  the  laser  return  will  deviate 
proportionally.  This  angle  can  be  detected,  sampled  and  made  available  to  the  fire  control 
system.  Signal  processing  is  then  required  to  process  these  angles  and  predict  when  the  barrel 
flex  will  be  close  enough  to  zero  so  that  the  shell  can  be  launched  through  a  barrel  that  is 
relatively  straight  A  preliminary  Kalman  filter  design  is  presented  in  this  chapter  and  is  shown 
to  perform  this  prediction  quite  well. 

First  the  gun  barrel  dynamics  will  be  modelled  by  considering  the  first  four  modes  of 
vibration  of  a  long,  flexible,  hollow  tube  with  the  physical  dimensions  of  a  tank  gun.  Then,  these 
equations  are  transformed  to  a  series  of  state  equations  that  can  be  used  for  simulations.  The 
power  spectrum  of  the  simulated  gun  is  compared  with  that  obtained  from  actual  field  data. 
Finally,  a  Kalman  filter  is  designed  with  a  subset  of  these  state  equations  and  its  ability  to  predict 
the  muzzle  pointing  angle  is  tested  on  actual  data. 

There  has  been  some  ground  work  that  used  Kalman  filten  in  dynamic  muzzle  referencing 
systems.  In  particular.  Levin  (1978)  used  a  simple  second  order  model  for  an  analog  Kalman 
filter  and  Baran  et  al.  (1987)  described  an  algoritlun  that  first  estimated  the  gun  barrel  model  (by 
finding  the  coefficients  of  an  auto-regressive,  moving  average  process)  with  the  first  few  seconds 
of  barrel  dynamics  measiuements  and  then  used  these  coefficients  in  a  Kalman  filter  to  predict 
the  muzzle  angle  20  ms  later.  The  encouraging  results  led  them  to  demonstrate  the  system  in 
real  time  on  an  Ml  Al  tank  ,  as  described  in  Brosseau  et  al.  (1990).  The  methods  described  in 
this  chapter  offer  another  alternative  to  developing  the  gun  barrel  model  for  the  predictive 
Kalman  filter;  that  is,  starting  from  the  modal  equations  of  a  long,  uniform,  hollow  tube  that 
approximates  the  gun  barrel. 


6.2  TRANSVERSE  VIBRATIONS  OF  LONG  HOLLOW  BEAMS 


The  theory  of  vibration  of  uniform  beams  is  a  well-studied  area.  In  general,  however  a  gim 
barrel  is  not  uniform.  It  has  several  different  cross  sections  along  its  length  and  is  very  often 
tapered  at  some  points.  Closed  form  solutions  for  the  modal  shapes  and  fiequencies  are  not 
known  in  general  and  require  extensive  modelling  and  numerical  simulation  efforts  to 
approximate.  Such  modelling  work  is  done  by  gun  designers  and  is  presented  in  detail  by  Cast 
(1987),  for  example. 

For  the  purposes  of  this  report,  however,  we  will  assume  the  gun  barrel  can  be  modelled 
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as  a  uniform  hollow  mbe  that  is  free  at  the  muzzle  end  and  is  either  frxed  or  frnged  (depending 
on  the  operation  of  the  gun  control  system)  at  the  mantlet  end.  The  development  in  this  chapter 
uses  standard  theory  of  free,  undamped,  transverse  vibrations  of  linearly  elastic  beams,  also 
known  as  BemouUi-Euler  beam  theory  (e.g.  Craig  (1991)).  There  are  a  number  of  assumptions 
in  Bemoulli-Euler  theory: 

a)  the  longitudinal  axis  of  the  beam  undergoes  no  extension  or  contraction; 

b)  transverse  shear  deformation  is  neglected; 

c)  the  material  is  linearly  elastic; 

d)  the  beam  has  uniform  cross>section;  and 

e)  the  slope  of  the  beam  remains  small. 

These  assumptions  are  not  unreasonable  for  an  approximation  of  the  gun  barrel  that  is  suitable 
for  a  short  term  predictive  model  for  the  Kalman  filter. 


Denote  the  displacement  of  the  centerline  of  the  beam  from  its  at-rest  centerline  as  ri(l.O- 
Note  that  T)  is  a  function  of  both  the  distance  along  the  beam,  /,  and  time,  t.  See  Fig.  6-1  for  a 
pictorial  representation  of  the  beam.  Using  standard  Newtonian  mechanics  and  the  above 
assumptions,  it  can  be  shown  that  T]  satisfies 


a/2 


a/2 


+ 


3^(/,0 

ar2 


=  MO 


(6-1) 


where  MO  is  an  external  applied  force,  £  is  the  elastic  modulus  of  the  material,  p  is  its  density, 
A  is  the  cross-sectional  area  and  I  is  the  transverse  moment  of  inertia  of  the  beam. 


Fig,  6-1:  Schematic  of  generic  flexible  beam 
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There  are  different  boundary  conditions  for  this  differential  equation  depending  on  the 
physical  constraints  placed  on  the  beam  for  fixed,  free  or  hinged  ends: 


Fixed  end: 


nde^t)  =  0 

ill  =0 

S'Jm, 


Free  end: 


T\0e,t)  =  0 


Hinged  end:  1  32^ 


Specifying  the  type  of  support  at  each  end  of  the  beam  will  provide  4  boundary  conditions.  To 
obtain  a  solution  for  the  u^orced  (f(l,t)=0)  part  of  (6-1),  we  must  make  an  assumption  on  the 
form  of  the  solution  ilf/.r).  It  is  assumed  Aat  the  temporal  and  spatial  portions  of  ti  can  be 
separated  as  the  product  of  a  modal  shape  function,  ^(l),  (that  depends  only  on  the  distance  /) 
and  a  simple  harmonic  function,  h(t)  =  Cq  cos((or  -  a),  that  depends  only  on  time: 

Ti(/,r)  =<[)(/)  hit)  =  Cq  4)(/)  cos(a)r  -  a)  (6-5) 


where  Cq  is  a  constant.  From  this,  we  see  that 


i^  =  -.0  (0^ 


Cq  ar  ^(0  cos(a)t  -  a) 
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Cq  cosCcor  -  a) 


Substituting  these  in  (6-1)  and  setting  yf/,r)=0  yields 


dl^ 


cocos(o)t-a)  -  pAcoQ>^(l)(/)cos(a)f-a)  =  0 


or  by  defining 


(6-6) 


then 


=  0  (6-7) 

dl"^ 

A  general  solution  to  (6-7)  is  well  known  to  be 

<!>(/)  =  c^sinhCX/)  +  C2Cosh(X/)  +  C3sin(Xi)  +  C4COs(Ai)  (6-8) 

where  we  have  5  unknowns  (the  4  amplitude  coefficients  and  the  eigenvalue  A,).  The  next  two 
subsections  use  different  sets  of  boundary  conditions  for  two  configurations  of  the  beam:  the 
hinged-fiee  beam  and  the  fixed-free  beam. 

6.2.1  Hinged'Free  Beam:  Modal  Shapes  and  Frequencies 


Assume  the  beam  is  hinged  at  1  =  0  and  free  at  /  =  L.  Now  apply  the  4  known  boundary 
conditions.  For  a  beam  hinged  at  /  =  0  boundary  conditions  (6-4)  imply 


<I)(0)  =0  =>  C2  +  C4  =  0 


=  0  =»  A,^(c2  -  C4)  =  0 


(6-9) 
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and  the  free  boundary  conditions  at  /  =  L  imply,  from  (6-3), 


=  0  =>  A.^(CiSinhXL  +  C2COshAL  -  c^siakL  -  c^coskL)  -  0 
l*L 

(6-10) 

=  0  X^(CiCOshXL  +  -  C3COSXL  +  C4sinAL)  =  0 

l^L 

To  get  a  nontrivial  (X^)  solution  to  (6-9)  we  see  that 

C2  =  C4  =  0 

Substituting  this  result  in  (6-10)  will  result  in 

X^(CiSinhXjL  -  c^sinXX)  =  0 

(6-11) 

X^(CiCoshX£  -  C3C0SXL)  =  0 
which  can  be  written  in  matrix  form  as: 


X^  sinhXL  -X,^  sinXL 

0 

X,^  coshXL  -X,^  cosXL_ 

53. 

0 

dl^ 


Again  for  this  to  have  a  non-trivial  solution,  we  can  set  the  determinant  of  this  matrix  to  0  and 
solve  for  XL: 


X^sinhXL 
X^  coshXL 


-X.^sinXL 
-X,^  cosXL 


=  0 


^  sinhXLcosXL  -  coshXLsinXL  =  0 
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This  equation  has  many  solutions,  a  few  of  which  were  found  numerically  and  are  listed  here: 


X^L  =  3.9266 
=  7.0686 

X3L  =  10.2102 
X4L  =  13.3518 


Now  from  the  definition  of  X  in  (6-6),  we  can  get  the  modal  frequencies 


pAL^ 


(6-12) 


(6-13) 


(Oi  =  (X^)^ 


Table  6-1:  Approximate  physical  parameters  of  a  lOSmm  gun  barrel 

L 

=  Length  of  barrel  =  5  m 

do 

=  Outer  diameter  =  0.125  m 

di 

=  Iimer  diameter  s  0.105  m 

A 

=  Cross-sectional  area  =  (7i/4)(d^^  -  d^)  -  0.00361  m^ 

/ 

=  Cross-sectional  moment  of  inertia  =  (7t/64)((L^  -  d^)  =  6.02x10*^  m'* 

E 

=  Elastic  modulus  of  steel  =  2.068x10^^  N/m^ 

P 

=  Density  of  steel  =  8(X)0  kg/m^ 

For  a  generic  lOSmm  tank  gun  barrel,  the  approximate  physical  parameters  in  Table  6-1 
can  be  used.  Combining  these  numerical  values  with  the  values  of  X^L  from  (6-12)  and 
substituting  in  (6-13)  yields  the  modal  frequencies  for  the  hineed-free  hollow  gun  tube: 


(Oi  =  (3.9266^)  (8.3)  =  128  rad/s  =  20.4  Hz 
©2  =  (7.0686^)  (8.3)  =  415  rad/s  =  66  Hz 
©3  =  (10.2102^)  (8.3)  =  865  rad/s  =  138  Hz 
©4  =  (13.3518^)  (8.3)  =  1480  rad/s  =  235  Hz 


(6-14) 


To  obtain  the  corresponding  modal  shape  functions,  we  return  to  finding  the  amplitude 


56 


coefficients  Cj.  From  the  first  equation  of  (6-11)  we  can  express 


sinAL 

sinhAjL 


and  since  we  previously  established  that  C2  =  C4  =  0  then  we  get  from  (6-8)  the  modal  shape 
functions  for  the  hineed-free  tube: 


<l>j(f)  =  C3 


sinXX-L  -t- 


sinA.^ 


sinhX^ 


sinhXjL^ 


(6-15) 


These  modal  shape  functions  (with  C3  arbitrarily  set  to  1)  are  plotted  in  Fig.  6-2. 


Modal  shapes:  Hinged-Free 


Fig.  6-2:  Modal  Shape  Functions  of  Hinged-Free  Hollow  Tube 


6.2.2  Fixed-Free  Beam:  Modal  Shapes  and  Frequencies 

In  the  second  situation,  we  assume  the  beam  is  fixed  at  /  =  0  and  free  at  /  =  L.  For  this 
case  the  boundary  conditions  at  /  =  0  come  from  (6-2): 
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cU 


<|)(0)  =0  =*  C2  +  C4  =  0 

=  0  =>  X,(Cj  +  C3)  =  0 


and,  as  before,  the  free  boundary  conditions  at  I  =  L  imply  from  (6-3) 

=  0  X^(cjSinhXL  +  C2C0shAZ>  -  C3SinXL  -  c^cosXL)  =  0 


dl^ 


dl- 


l^L 


=  0  X^(CjCoshXL  +  C2sinhXL  -  c^cosKL  +  c^smkL)  =  0 


J/=L 


These  4  equations  can  be  written  in  matrix  form  as: 


0 

X 


1 

0 


0 

X 


1 

0 


A,^coshXL  X^sinhXI.  -X^cosXL  -X^sinXL 


■ 

0 

C2 

0 

C3 

0 

54 

p 

(6-16) 


As  before,  a  nontrivial  set  of  solutions  to  this  set  of  equations  is  obtained  if  the  determinant  of 
the  matrix  is  set  to  zero: 


0  10  1 

X  0  X  0 

X^sinhXL  X^coshAL  -X^sinXL  -X^cosXzJ 
X^  coshAL  A,^  sinhAL  -A,^  cosAZ,  -A,^  sinAX 


=  0 


=»  cosAZ.  coshAZ,  +  1=0 

Numerical  solution  of  this  equation  leads  us  again  to  several  solutions,  one  for  each  mode: 

A-jL  =  1.8751 
A^  =  4.6941 
A^L  =  7.8548 
X4L  =  10.996 
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so  substituting  these  (6-13)  yields  the  modal  frequencies  for  the  fixea-free  hollow  gun  tube: 

Q)i  =  (1.875^)  (8.3)  =  29  rad/s  =  4.6  Hz 
©2  =  (4.694^)  (8.3)  =  183  rad/s  =  29  Hz 
©3  =  (7.855^)  (8.3)  =  512  rad/s  =  82  Hz 
©4  =  (10.996^)  (8.3)  =  1004  rad/s  =  160  Hz 


To  obtain  the  corresponding  modal  shape  functions  of  the  fixed-free  beam,  we  need  the 
amplitude  coefficients  c,-.  It  is  straightforward  to  show  from  (6-16)  that 


Cj  =  -C2 


coshXjL  +  cosXjL 
sinhXjL  +  sinX^ 


so  that  by  leaving  C2  arbitrary  and  substituting  these  coefficients  in  the  general  modal  shape 
equation  (6-8),  then  the  mode  shapes  for  the  fixed-free  beam  are  (and  as  plotted  in  Fig.  6-3): 


<)),•(/)  =  C2 


/  if  I  I 

coshX^—  -  cosX/^  -  sinhX^_  -  sinXjL— 
Li  Lt  L  L 


where  r,- 


coshX^  +  coshX^ 
sinhXjL  +  sinX^L 


(6-18) 


6.3  FORMULATION  OF  STATE  EQUATIONS 


With  the  assumed  form  of  the  solution  of  the  main  differential  equation  (6-1)  describing 
the  dynamics  of  a  transversely  vibrating  beam  having  been  established  in  the  previous  section 
as  a  product  of  the  modal  shape  functions,  (6-15)  or  (6-18),  with  time-varying  simple  harmonic 
functions,  it  is  possible  to  derive  a  set  of  state  equations  that  describe  the  relative  contributions 
of  these  mode  shapes  at  any  point  along  the  beam,  at  any  time  and  given  any  forcing  function 
and/or  initial  conditions.  These  state  equations  then  form  the  basis  of  the  pr^ction  filter. 


6.3.1  Development  of  the  State  Equations 


The  method  described  in  Sasiadek  and  Srinivasan  (1989)  was  used  to  derive  the  state 
equations  and  is  summarized  here.  The  beam  is  considered  to  be  of  the  fixed-free  configuration 
of  Section  6.2.2  so  the  modal  shape  functions  of  (6-18)  are  used,  but  an  additional  degree  of 
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Modal  shapes:  Fixed-Free 


Fig.  6-3;  Modal  Shape  Functions  of  Fixed-Free  Hollow  Tube 

freedom  is  introduced  at  the  "fixed"  end  by  allowing  that  end  to  rotate  by  an  angle  6  (see 
Fig.  6-1).  In  this  way  we  could  introduce  a  control  action  at  the  fixed  end  to  drive  the  beam  to 
any  desired  pointing  angle.  In  essence  this  is  a  reasonable  representation  of  the  gun  barrel 
attached  to  the  gun  control  system. 

The  assumed  mode  solution  describes  the  deflection  of  any  point  of  the  beam  as  the 
product  of  the  modal  shape  functions,  <|)//)  from  (6-18),  with  arbitrary  temporal  functions,  e/r), 
which  in  vector  form  is  denoted  by 


Tl(/,r)  =  e{tf  m  = 

i*l 


(6-19) 


If  we  choose  our  state  vector  as 

x^(0  :=  [  0(0  ej(0  e^it)  -  g„(0 

then  Sasiadek  and  Srinivasan  (1989)  show  that  the  dynamic  equation  representing  the  undamped 
transverse  vibrations  of  the  beam  pictured  in  Fig.  6-1  is 
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M  +  K  =  f 


(6-20) 


where 


and  where 


niQ  :=  pAL^/3 
L 

■=  pA 

0 

L 

:=  pA^m^'^mdl 

0 

’  0  3/^ 

T  ;=  applied  torque  at  the  hinged  end 

Note  that  the  second  derivatives  of  the  modal  shape  functions  are  obtained  from  (6-18)  as 


a2<t).(0 

~ir 


=  Co 


coslbljL-i  +  cosX^J. 

Lt  L 


sinhX^-i  +  sinX^-L 
L  L 


Since,  in  reality,  the  oscillations  are  not  undamped,  we  introduce  a  damping  matrix  into  (6-20) 
denoted  by  D  :=  diag  ^2  ...  ]  so  that  the  damped  dynamic  equation  becomes 


M  +  D  +  K  =  f 


or  in  more  convenient  state  space  form: 
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-M'^D 

-M-^K 

+ 

5c. 

[/] 

[0] 

5c 

[0] 

(6-21) 


where  [/]  represents  the  (n+1)  by  (n+l)  identity  matrix  and  [0]  is  the  similarly  dimensioned  zero 
matrix.  The  gun  barrel  dynamics  as  specified  in  this  last  equation  are  now  of  the  fonn 
i  -  Fx  +  Gu  that  can  readily  be  modelled  in  a  Kalman  filter. 


6.32  Numerical  Calculations  and  Simulations 

To  make  the  state  equation,  (6-21),  more  concrete,  we  can  compute  some  nun^rical  values. 
Commercial  numerical  software  was  used  to  compute  the  various  integrals  for  terms  of  the  state 
dynamics  matrices  and  the  inverse  and  products  of  the  various  matrices.  The  physical  gun 
parameters  of  Table  6-1  were  used  to  calculate  the  first  4  modes.  The  integrals  evaluated  to 

niQ  =  1204.28 


410.98 

144.5 

0 

0 

0 

65.62 

0 

144.5 

0 

0 

23.47 

0 

0 

144.5 

0 

11.89 

0 

0 

0 

144.5_ 

123054 

-18.22 

42.66 

-47.93 

-18.22 

4.833x10^ 

-1114.5 

1223.54 

42.66 

-1114.5 

3.79x10^ 

-2230.7 

-47.93 

1223.54 

-2230.7 

1.455x10* 

and  when  the  damping  matrix  was  chosen  as 

D  =  diag  [2000  0.1  0.1  0.1  O.l] 

then  the  continuous  time  state  equations,  (6-21),  with  an  abbreviation  of  notation,  are 

i  =  Fx  +  Gf 

[o  Cj  €2  ^3  6  gj  62  ^3  C4] 
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where  the  coefficient  matrices  are 

F  matrix: 


1.665e+07 

4.737e+07 

7.563e+06 

2.704e+06 

2.377e+06 

0 

0 

0 

0 

0 


G  matrix: 


1.391 

-3.95651 

-0.631614 

-0.225851 

-0.114447 

-3.95651 

11.2607 

1.79654 

0.642401 

0.325529 

-0.631614 

1.79654 

0.293719 

0.102552 

5.196719e-02 

-0.225851 

0.642401 

0.102552 

4.358950e-02 

1.858225e-02 

-0.114447 

0.325529 

5.196719e-02 

1.858225e-02 

1.633524e-02 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

-2782  0.39  5  6.316e-02  2.258e-02  1.144e-02 

7913  -1.12  -0.179  -6.424e-02  -3.255e-02 

1263.2  -0.179  -2.93e-02  -1.025e-02  -5.196e-03 

451.7  -6.424e-02  -1.025e-02  -4.358e-03  -1.858e-03 
228.9  -3.255e-02  -5.196e-03  -1.858e-03  -1.633e-03 
0 
1 
0 
0 
0 


0  4.87e+05  3.052e+06  8.558e+06 
0  -1.38e+06  -8.682e+06  -2.434e+07 
0  -2.21e+05  -1.419e+06  -3.886e+06 


0 

0 

0 

0 

0 

0 

0 


-79049  -4. 
-40057  -2. 
0 
0 
0 
0 
0 


956e+05  -1.651e+06 
511e+05  -7.041e+05 
0  0 

0  0 

0  0 

0  0 

0  0 


The  time-varying  magnitudes  of  the  various  states  are  dependent  on  the  initial  conditions 
and  input  forcing  function/.  Computer  simulations  were  conducted  on  the  above  barrel  model 
with  a  relatively  large  (2  cm)  initial  amplitude  on  mode  1  (state  gj)  and  no  input  forces,  /=0. 
The  output,  y(t),  was  chosen  as  the  displacement  at  the  free  end  of  the  beam: 

4 

yit)  :=  Ti(L.O  =  '£(eimiiL)) 

j=i 

=  2e^it)  -  2«2(0  +  2^3(0  -  2^4(0 
=  [0000002-2  2  -2]  xit) 
where  the  values  for  (()/Lj  are  obtained  from  (6-18)  with  /  =  L. 


The  resulting  time  history  of  the  output  is  shown  below  in  Fig.  6-4.  Note  that  the  motion 
is  primarily  a  damped  sinusoid,  with  an  apparently  clean  harmonic  content.  The  power  spectral 
density  (PSD)  function  of  the  tip  displacement  is  shown  in  Fig.  6-5.  A  sampling  frequency  of 
600  Hz  was  used  in  the  simulation  so  the  response  of  all  modes  could  be  observed.  Note  that 
the  modal  frequencies  now  match  those  of  a  hinged-free  beam  because  of  the  introduction  of  the 
extra  degree  of  freedom  at  the  "fixed"  end,  i.e.  the  angle  0.  Mode  1  is  by  far  dominant,  being 
at  least  40  db  higher  than  mode  2.  Higher  modes  are  even  less  significant.  This  observation  will 
be  exploited  in  the  design  of  the  Kalman  filter  -  only  the  first  two  modes  will  be  modelled. 
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Fig.  6-4:  Simulated  tip  motion  Fig.  6-5:  PSD  of  simulated  tip  motion 


6.3  J  Experimental  Corroboration 


The  model  of  the  tank  gun  barrel  was  partly  validated  by  a  series  of  field  trials  conducted 
on  a  Leopard  Cl  tank  with  a  105mm  gun  as  described  in  Bird  (1990).  Briefly,  the  barrel  was 
instrumented  with  a  number  of  accelerometers  and  gyroscopes  and  the  tank  was  driven  over 
various  types  of  natural  and  artificial  terrain.  Gyros  mounted  in  the  elevation  plane  at  the 
mantlet  and  the  muzzle  of  the  gun  provided  angular  rate  signals  that  were  sampled  at  60  Hz  and 
numerically  integrated  to  give  the  mantlet  and  muzzle  elevation  angles  such  as  those  shown  in 
Fig.  6-6  below.  An  estimate  of  the  elevation  flex  of  the  barrel  was  obtained  by  subtracting  the 
mantlet  angle  fiom  the  muzzle  angle  resulting  in  the  "derived  flex"  shown  in  Fig.  6-7.  The 
power  spectral  density  of  this  is  shown  in  Fig.  6-8.  Unfortunately,  the  signals  were  sampled  at 
only  60  Hz  so  PSD  information  is  only  valid  up  to  30  Hz.  The  dominant  mode  at  about  20  Hz 
appears  as  expected  but  higher  modes  are  cut  off  by  anti-aliasing  filters  at  30  Hz.  As  well,  the 
broadband  power  seen  in  the  1  Hz  to  5  Hz  region  is  that  of  the  tank  moving  over  the  ground  at 
moderate  speeds  and  was  not  included  in  the  simulations  of  the  last  section.  Nonetheless,  it  is 
encouraging  to  see  at  least  general  agreement  between  simulated  and  experimental  results.  In 
future  experiments  it  would  be  valuable  to  conduct  more  controlled  tests  with  the  tank  stationary 
with  barrel  motion  induced  by  initial  displacements  and  with  high  speed  data  recording  to  better 
validate  the  model. 

In  any  event,  it  will  be  assumed  that  the  model  is  a  reasonable  approximation  of  the 
dynamics.  Of  course,  a  number  of  assumptions  have  already  been  made  to  arrive  at  the  linear 
state  equations,  not  the  least  of  which  is  that  the  barrel  has  a  uniform  cross-section  along  its 
length.  If  this  assumption  is  not  made,  there  is  no  closed-form  solution  available  and  the 
dynamics  must  be  simulated  by  complex  numerical  techniques  such  as  finite  element  methods 
and  a  Kalman  filter  would  not  be  a  candidate  for  muzzle  pointing  prediction  algorithms.  The 
state  space  model  lends  itself  immediately  to  such  techniques. 
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t  c« 


t  C<3 


Fig.  6-6:  Measured  barrel  angles  Fig.  6-7:  Derived  barrel  flex 


PSD  Cl*izz-IBnt]  anal*  Carad<>«2/W 


f  CHO 


Fig.  6-8:  PSD  of  flex 

6.4  A  KALMAN  FILTER  FOR  THE  DMRS 
6.4.1  Filter  Design 

This  section  describes  the  design  of  a  Kalman  filter  based  on  the  previously  developed  state 
equations.  The  filter  is  tested  on  its  ability  to  predict  the  muzzle  pointing  angle  of  the  real  data 
in  the  next  section. 

From  the  observations  of  the  last  section,  only  the  first  two  modes  of  vibration  are 
considered,  so  our  state  equation  is 
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X  =  Fx  +  Gf 


where 


d 


/ 


t 

0 


and  where  the  coefficient  matrices  (for  the  2  mode  case)  work  out  to  be,  from  (6-21), 


F  matrix: 


-363.15  5.16462e-02  8.24476e-03 

1032.9  -0.14759  -2.34511e-02 

164.9  -2.34511e-02  -4.43573e-03 
10  0 
0  10 
0  0  1 


0 

0 

0 

0 

0 

0 


63551 

-1.81614e+05 

-28857 

0 

0 

0 


3.984876+05 

-1.133446+06 

-2.143896+05 

0 

0 

0 


G  matrix: 


0.181574 

-0.516462 

-8.2447566-02 

0 

0 

0 


-0.516462 

1.47592 

0.234511 

0 

0 

0 


-8.2447566-02 

0.234511 

4.4357326-02 

0 

0 

0 


Define  the  product  Gf  as 


w  :=  G/  = 


0.1816  X 

-0.5165  X 
-0.08244  X 
0 
0 
0 


(6-22) 


The  forcing  function,  x,  is  modelled  as  a  Gaussian  white  noise  stochastic  process  with  zero  mean 
(E  [x]  =  0)  and  power  spectral  density  (see  Appendix  B  for  a  justification  of  this): 
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E[x(gx(ri,)]  =  5.0 


Thus  the  power  spectral  density  of  the  input  forcing  vector,  w,  is 


0.1816 

0.1816 

-0.5165 

-0.5165 

E[w(gw^(r^)]  = 

-0.08245 

0 

E[T(r^)t(r^)] 

-0.08245 

0 

0 

0 

0 

0 

0.16 

0 

0 

0  0 

0 

0 

1.3 

0 

0  0 

0 

0 

0 

0.03  0  0 

0 

5(^a-f&) 

:=  QHt, 

0 

0 

0 

0  0 

0 

0 

0 

0 

0  0 

0 

_  0 

0 

0 

0  0 

0_ 

So  in  summary,  the  state  model  so  far  is 

at)  =  F  x(0  +  wit) 

EMtJw'^it^)]  =  Q  5(r^-fp 


(6-23) 


This  is  exactly  the  form  of  the  continuous  time  stochastic  system  of  (2-2)  which  can  readily  be 
converted  to  the  discrete  time  system 


E[w*wJ]  = 

according  to  the  discretization  procedure  (2-3). 

The  measurement  for  the  filter  will  be  the  angle,  \j/,  of  the  muzzle  with  respect  to  the 
mantlet  (see  Fig.  6-9)  which  can  be  related  to  the  vertical  displacement  of  the  muzzle  from  the 
centreline  of  the  barrel,  and  the  length  of  the  gun,  L: 
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\\f{t)  =  sin"^ 


L 


Fig.  6-9:  Measured  angle  from  muzzle  reference  system 

The  mandet-mounted  laser  transceiver  of  the  muzzle  reference  system  measures  the  angular  flex 
of  the  barrel  using  a  reflecting  mirror  mounted  on  the  muzzle.  This  measurement  consists  of  the 
angle,  X|r,  plus  a  random  noise  component,  v^: 

:=  vCg  + 

*  - —  + 

L  * 

1  2 

=  1  j;  4), •(£.)«, (rp  + 

^  j-i 

=  ^  [0  0  0  0  2  -2]  .  V* 

=:  H 


Finally  we  take  the  measurement  noise  to  be  zero  mean  and  covariance 


E[Vj^Vy]  =  (0.2  mrad)^  5^^ 

=  (0.0002  rad)^  5^- 
.=  Rj^  5j^- 

This  noise  level  was  chosen  based  on  expected  MRS  performance  and  also  happens  to  describe 
the  extent  of  the  noise  seen  in  the  field  data  of  the  next  section  quite  weU. 


6.4  J  Filter  Execution  on  Real  Data 


Now  that  the  specification  of  the  filter  is  complete,  the  derived  barrel  flex  from  the 
measured  field  trial  data,  Fig.  6-7,  was  used  as  the  data  sequence,  z^,  to  drive  the  filter  of  the 
previous  section.  It  is  difficult  to  evaluate  the  performance  of  the  filter  because  there  is  no  truth 
data  available  that  would  definitively  indicate  how  well  the  filter  is  predicting  the  future  muzzle 
pointing  angle.  All  we  have  is  the  sequence  of  noisy  measurement  data.  However  it  is  possible 
to  qualitatively  evaluate  the  filter  by  looking  at  the  predicted  muzzle  angle  relative  to  the 
measured  angle  as  a  function  of  time.  The  filter  was  used  to  predict  what  the  measured  flex 

would  be  3  steps  (or  SO  ms,  since  the  measurement  rate  is  60  Hz)  ahead,  4^31^ 

(The  notation  here  is  the  same  as  in  Chapter  2.) 

Shown  in  Fig.  6>10  below  is  a  short  section  of  the  measured  barrel  flex  as  derived  fiom 
the  difierence  of  the  two  gyros  at  opposite  ends  of  the  gun.  The  solid  line  is  the  acmal 
measurement  sequence,  z^,  fed  to  the  ^ter  and  the  dotted  line  is  the  what  the  filter  predicted  the 
measurement  would  be  at  that  point  based  only  on  data  received  up  to  3  steps  (SO  ms)  before  that 

point,  i.e.,  =  H^_3  <I>^_3  It  is  fairly  evident  from  Fig.  6-10  that  the  filter  is 

predicting  the  gun  flex  quite  well.  Given  that  the  filter  was  told  that  the  standard  deviation  of 
the  measurement  noise  was  0.2  mrad,  the  differences  between  measured  and  predicted  muzzle 
angles  all  appear  to  be  of  that  order,  as  could  be  expected,  in  that  section  of  the  data  sequence. 

However,  there  are  other  portions  of  the  measured  barrel  flex  data  sequence  that  were  not 
as  satisfactorily  predicted  by  the  filter.  One  of  these  is  shown  in  Fig.  6-11.  What  is  different 
about  this  portion  is  that  the  20  Hz  vibratory  mode  is  not  dominant  fix)m  about  r=12.2  to  ^=13.2. 
During  that  time  that  tank  likely  experienced  a  fairly  long  (1/2)  second  upward  acceleration 
followed  by  a  similar  downward  acceleration  that  essentially  biased  the  shape  of  the  gim  barrel 
slightly  while  the  accelerations  were  occurring.  This  effect  was  not  included  in  the  barrel  model 
used  by  the  Kalman  filter  and  hence  the  predicted  measurements  during  these  times  are  not 
particularly  good.  In  fact  they  tend  to  lag  behind  by  3  or  4  samples.  After  the  acceleration 
transients  die  away  at  about  13.2  sec,  the  filter  returns  to  fairly  good  prediction  performance. 
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Measured  and  3  step  ahead  (50  ms)  filter-predicted  flex 


t(s) 


Fig.  6-10:  Real  barrel  flex  measurements  and  3-step  ahead  Kalman  niter 

prediction.  This  shows  fairly  good  muzzle  angle  prediction  when 
the  20  Hz  mode  is  the  dominant. 


Measured  and  3  step  ahead  (SO  ms)  filter-predicted  flex 


Fig.  6-11:  Real  barrel  flex  measurements  and  3-step  ahead  Kalman  filter 

prediction.  This  shows  poorer  muzzle  angle  predic -on  when 
unmodelled  accelerations  dominate. 
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6.4  J  Discussion  of  Filter  Results 

The  Kalman  filter  design,  as  presented,  is  not  yet  of  sufficient  fidelity  to  include  in  a  real¬ 
time  predictive  DMRS  since  it  does  not  accurately  model  the  low  frequency  effects  caused  by 
sustained  accelerations  as  manifested  in  Fig.  6-11.  This  is  not  an  insurmountable  problem. 
Relatively  modest  changes  to  the  state  equations,  process  noise  models,  and  software  simulator 
and  careful  tuning  of  the  noise  parameters  would  yield  a  filter  that  could  predict  the  muzzle  angle 
through  these  sustained  accelerations  as  accurately  as  the  current  model  can  predict  the  higher 
frequency  vibrations.  This  has  not  yet  been  done  since  the  filter  so  far  has  been  designed  around 
the  angular  flex  data  derived  from  gyroscopes,  while  the  DMRS  system  that  will  be  installed  on 
the  tank  wUl  be  laser  and  mirror  based.  Tltis  is  such  a  sufficient  difference  that  fine-tuning  the 
model  on  the  existing  data  may  not  yield  a  suitable  filter  for  data  from  the  laser  system.  In  any 
event,  the  results  so  far  have  been  quite  encouraging  and  the  modelling  efforts  in  this  chapter 
should  be  a  good  launching  point  for  further  stutties  on  predictive  muzzle  referencing  systems. 
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7.0  A  POTENTIAL  ADM  ARCHITECTURE 


This  chapter  presents  a  preliminaiy  proposal  for  an  overall  architecture  of  an  Advanced 
Development  Model  for  a  highly  advanced  fire-on-the-move  fire  control  system  for  future  direct- 
fire  support  vehicles.  The  previous  chapters  have  dealt  in  detail  with  some  of  the  more  pressing 
problems  such  as  trajectory  prediction  and  dynamic  muzzle  referencing.  However  it  may  be 
useful  to  briefly  step  back  and  look  at  the  overall  system  as  a  whole. 

Fig.  7-1  is  an  attempt  at  showing  both  the  major  system  components  and  the  sequence  of 
events  that  would  occur  as  the  data  travels  through  the  system  firom  the  time  of  initial  target 
detection  until  the  weapon  is  fired. 

First,  we  assume  that  there  will  be  two  operators  of  the  system.  In  current  generations  of 
vehicles,  they  are  called  Commander  and  Gunner  but  we  shall  use  the  more  generic  terms 
Observer  and  Engager.  The  diagram  has  a  top  portion  for  the  equipment  associated  with  the 
observer’s  duties  and  a  bottom  portion  for  equipment  associated  with  the  engager’s.  Each 
operator  has  his  own  imaging  sensor(s)  that  can  be  aimed  independently  of  the  weapon  and  each 
other.  Associated  with  each  operator  station,  is  a  high-speed,  dedicated  image  processing 
computer  that  can  be  configured  by  the  operator  to  aid  in  image  enhancement  (by  contrast 
stretching,  motion  highlighting,  etc.)  image  stabilization  (jitter  removal  by  registering  the  image 
against  a  stationary  background),  target  extraction  (by  highlighting  potenti^  targets  and  extracting 
the  more  promising  ones)  and  target  tracking  (by  running  Kalr^  filters  similar  to  those  in 
Chapter  4)  to  assist  in  finding  the  target  in  the  next  scan. 

A  sensor  control  computer  will  be  used  to  control  the  functions  of  each  image  processor 
and  act  as  the  human  interface  to  the  system.  This  control  computer  can  be  used  to  suggest  a 
prioritization  of  the  targets  to  the  observer,  possibly  assist  in  their  identification,  accept  all 
operator  hand  or  voice  inputs,  and  cue  the  imaging  sensor  to  follow  a  specific  target  or  the 
operator’s  hand  control.  The  control  computers  of  the  two  stations  would  be  in  constant 
communication  so  that  targets  could  be  handed  off  from  the  observer  to  the  engager,  or  in 
emergencies  could  redirect  the  output  of  one  image  processor  to  the  other  operator’s  display. 

When  it  is  decided  that  a  particular  target  is  to  be  engaged,  the  engager’s  control  computer 
would  concentrate  solely  on  that  target.  It  would  run  a  more  sophisticated  Kalman  tracking  ^ter, 
perhaps  with  more  states,  maneuver  detectors,  etc,  to  attempt  to  estimate  very  accurately  the  true 
state  of  the  target  It  would  drive  the  imaging  sensor  to  closely  follow  that  target  An  interesting 
possibility  is  that  it  might  be  able  to  estimate  the  probability  of  hitting  the  target  based  on  its 
estimate  of  the  target  acceleration,  for  example. 

Provided  the  engager  is  satisfied  with  his  chance  of  success,  the  laser  range  finder  (LRF), 
environment  sensors  (wind,  air  pressiu*,  temperature,  etc)  would  be  activated  by  the  control 
computer  and  the  ballistic  solution  would  be  calculated  based  on  the  data  from  these  sensors  and 
the  target  velocity/acceleration  available  from  the  target  state  estimator.  The  gun  control  servos 
would  slew  the  gun  to  the  proper  lead  angles  in  preparation  for  firing.  At  this  point,  an  optional 
interrogation  of  the  target  might  take  place  based  on  an  optical  IFF  (Identify  Friend  or  Foe) 
system  and  the  computer  would  inform  the  engager  that  firing  can  commence. 
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Fig.  7-1:  A  Potential  ADM  Architecture 


When  the  engager  presses  the  firing  button,  there  may  be  a  slight  delay  as  the  barrel  flex 
data  from  the  DMKS  (Dynamic  Muzzle  Reference  System)  laser  on  the  gtm  barrel  (and  possibly 
other  vehicle  dynamics  from  the  onboard  Inertial  Navigation  System  (INS))  is  processed  through 
a  predictive  Kalman  tilter  similar  to  that  of  Chapter  6  and  a  barrel  zero  crossing  time  is 
pr^cted.  The  charge  would  be  ignited  at  a  time  such  that  the  shell  could  be  expected  to  exit 
the  muzzle  at  a  zero  crossing  time. 

After  the  results  of  the  initial  shot  are  observed,  the  observer  will  have  the  next  target  ready 
fOT  the  engager.  The  target  is  handed  off  to  the  engager’s  control  computer  and  the  process 
repeats. 

From  this  very  cursory  design,  it  can  be  seen  that  such  a  system  is  very  flexible,  powerful 
and  very  comprehensive.  The  algorithms  discussed  in  this  report  make  up  just  two  of  the  overall 
components,  the  optimal  firing  time  solution  and  the  target  state  estimation.  Much  more  work 
remains  to  be  done  before  such  a  system  is  ready  to  be  fielded. 
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8.0  SUMMARY 


This  report  has  summarized  some  applications  of  Kalman  filters  in  the  fire  control  systems 
of  future  direct-fire  support  vehicles,  especially  in  the  high  dynamic  moving-target/moving- 
platform  scenario.  Two  areas  were  studied  in  some  detail,  target  state  estimation  and  dynamic 
muzzle  referencing.  A  number  of  modelling  studies  were  conducted,  simulation  software  was 
written  and  exercised,  candidate  filters  were  designed  and  implemented  and,  where  possible,  real 
data  was  used  to  test  the  resulting  filters.  The  results  show  sufficient  potential  to  conclude  that 
such  techniques  can  be  extremely  useful  in  predicting  the  dynamics  of  both  the  target  and  the 
firing  platform.  An  overall  architecture  of  an  advanced  development  model  was  proposed  to 
establish  the  context  in  which  the  filters  of  this  report  can  play  a  vital  role. 


75 


REFERENCES 


Baran,  R.,  et  al,  "Stochastic  Modeling  for  Improved  Weapon  Performance,"  Proc.  Fifth  U.S. 
Army  Symposium  on  Gun  Dynamics,  U.S.  Army  Research,  Development  and  Engineering 
Center,  Watervliet,  New  York,  23-25  September  1987. 

Bird,  J.S„  "Measurement  of  Tank  Gun  Dynamics  in  Support  of  a  Dynamic  Muzzle  Referencing 
System,"  Defence  Research  Establishment  Ottawa  Technical  Report  1053,  December  1990. 

Blackman,  S.S.,  Multiple  Target  Tracking  with  Radar  Applications,  Artech  House,  Dedham,  MA, 
1986. 

Bogler,  P.L.,  Radar  Principles  with  Applications  to  Tracking  Systems,  Wiley  &  Sons,  New  York, 
1990. 

Brosseau,  T.L.,  M.D.  Kregel,  and  A.F.  Baran,"  Autonomous  Accuracy  Enhancement  System," 
Proc.  Sixth  US  Army  Symposium  on  Gun  Dynamics,  U.S.  Army  Research,  Development  and 
Engineering  Center,  Watervliet,  New  York,  1990. 

Buike,  H.H.,  T.R.  Perkins,  and  J.F.  Leathrum,  "State  Estimation  of  Maneuvering  Vehicles  via 
Kalman  Filtering,"  US  Army  AMSAA  Tech.  Report  No.  186,  1976. 

Chang,  C.B.  and  J.A.  Tabaczynski,  "Application  of  State  Estimation  to  Target  Tracking,"  IEEE 
Trans.  Automatic  Control,  Vol.  AC-29,  No.  2,  1984. 

Craig,  R.R.  Jr.,  Structural  Dynamics  -  An  Introduction  to  Computer  Methods,  Wiley  &  Sons, 
New  York,  1981. 

Farina,  A.  and  F.A.  Studer,  Radar  Data  Processing:  Vol.  I  -  Introduction  and  Tracking,  Wiley 
&  Sons,  New  York,  1985. 

Fitzgerald,  R.J.,  "Simple  Tracking  Filters:  Qosed-Form  Solutions,"  IEEE  Trans.  Aerospace  and 
Electronic  Sys.,  Vol.  AES- 17,  No.  6,  1981. 

Gast,  R.G.,  "Normal  Modes  Analysis  of  Gun  Vibrations  by  the  Uniform  Segment  Method,"  Proc. 
Fifth  U.S.  Army  Synyjosium  on  Gun  Dynamics,  U.S.  Army  Research,  Development  and 
Engineering  Center,  Watervliet,  New  York,  23-25  September  1987. 

Gelb,  A.,  Applied  Optimal  Estimation,  M.I.T.  Press,  Cambridge,  Ma.,  1974. 

Goldstein,  H.,  Classical  Mechanics,  Addison  Wesley,  Reading,  Ma.,  1950. 

Levin,  V.,  "Accuracy  Improvement  of  Flexible  Gun  Tubes  -  A  Kalman  Filter  Approach,"  Proc. 
Second  U.S.  Army  Symposium  on  Gun  Dynamics,  U.S.  Army  Research,  Development  and 
Engineering  Center,  Watervliet,  New  York,  19-22  September  1978. 


76 


McMillan,  J.C.,  "An  Integrated  System  for  Land  Navigation,"  Journal  of  the  Institute  of 
Navigation,  Vol.  34,  No.  1,  1987. 

McMillan,  J.C.,  and  Sang  Seok  Lim,  "Data  Association  Algorithms  for  Multiple  Target 
Tracking,"  Defence  Research  Establishment  Ottawa  Technical  Report  1040,  July  1990. 

Rouhi,  A.  and  M.  Farooq,  "Development  of  a  Multiple  Structure  Adaptive  Target  Tracking 
Technique,"  Royal  Military  College  of  Canada,  Tech.  Report  No.  89/9,  1989. 

Roy,  J.M.J,  "Overview  of  Multisensor  Tracking  and  Classification  of  Maneuvering  Targets  in  a 
Cluttered  Environment,"  Defence  Research  Establishment  Valcartier  Memorandum  DREV- 
M-3018/90,  April  1990. 

Sasiadek,  J.Z.,  and  R.  Srinivasan,  "Dynamic  Modelling  and  Adaptive  Control  of  a  Single-Link 
Flexible  Manipulator,"  AIAA  J.  Guidance.  Control  and  Dynamics,  Vol.  12,  No.  6,  1989. 

Sorenson,  H.W,.  Editor,  Kalman  Filtering:  Theory  and  Application,  IEEE  Press,  New  York, 
1985. 

TTCP-WAGIO,  "Tank  Gun  Systems  Accuracy,”  Final  Report,  TTCP  Sub-group  W,  Action  Group 
10,  September  1989. 

Woolfson,  M.S.,  "An  Evaluation  of  Manoeuvre  Detector  Algorithm,"  GEC  Journal  of  Research, 
Vol.  3,  No.  3,  1985. 


77 


APPENDIX  A.  DERIVATION  OF  Q  VALUES  FOR  THE  TRACKING  FILTERS 
The  general  continuous-time  model  of  target  motions,  from  (2-2),  is 

x^it)  =  Fx^it)  +  w^it)  (A-1) 

with  the  covariance  of  the  driving  process  given  by 

E  =  e^(r)6(r-x) 

If  we  look  only  at  the  velocity  state  in  one  horizontal  direction,  say  Vyg,  the  randon  walk  velocity 
(RWV-r)  continuous  time  velocity  model  is  driven  by  white  noise  (tom  Eqn.  (3-14)): 

We  wish  to  estimate  a  value,  Q^,  for  the  covariance  of  We  will  approach  the  problem  first 

tom  the  discrete-time  point  of  view  and  then  return  to  continuous  time.  The  discrete  time 
version  of  (A-1)  is,  as  shown  by  (2-1): 

^k 

where,  tom  (2-3), 

~  (A-4) 

But  since  F=0  for  the  velocity  state  (A-2)  of  the  RWV  model,  then  d>  =  1.  The  discrete-time 

velocity  model  is  thus 

=  vy^(g  +  (A-5) 

where  we  have  simplified  notation  by  redefining  as  the  scalar  noise  process  driving  the  Vyg 
velocity  state.  The  covariance  of  this  discrete  driving  noise  is  also  given  by  (2-3): 

E{wJ}  =  G*  =  (A-6) 

but  since  F=0,  this  simplifies  to 
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Qk  =  f‘*‘(2c(T)dx 


(A-7) 


which,  for  sufficiently  small  time  steps  ^  approximated  by 


Qk  “  Qc^h^  (^k*i  ~ 


(A-8) 


I 


Thus  by  estimating  a  value  for  Qj^  =  E{wj^^),  we  can  obtain  the  we  are  looking  for. 

Let  us  assume  that  a  reasonably  maneuverable  ground  target  is  to  be  tracked,  say  one  that 
can  accelerate  from  0  to  100  km/hr  in  5  seconds,  or  equivalendy,  can  execute  a  90  degree  turn 
at  100  km/hr  in  5  seconds  (both  of  which  are  quite  realistic  for  modem  fighting  vehicles).  This 
is  equivalent  to  an  acceleration  of  5.55  m/s^.  With  a  discretization  time  step  of  -  tj^  =  0.1s, 
this  corresponds  to  a  velocity  change  of  0.555  m/s  in  0.1s.  Thus  we  will  model  the  noise  driving 
the  discrete  velocity  state  as  an  uncorrelated  Gaussian  sequence  with  zero  mean  and  covariance 


Q*  =  (0.555  m/sf 
=  0.3  m^/s^ 


(A-9) 


so  that  from  (A-8), 


Qk^  (^*+1 

=  0.3  /  0.1  (A- 10) 

=  3  m^/s^ 

In  the  vertical  direction,  we  assume  the  vehicle  is  only  a  tenth  as  maneuverable  as  it  is 
horizontally.  Thus  Qj^  in  the  vertical  is  (0.0555  m/s)^  so  the  corresponding  is  0.03  m^/s^. 
These  are  the  values  used  in  the  matrix  in  the  RWV(r)  simulations  of  Chapters  4  and  5. 

For  the  angular  rate  model,  RWV(s),  a  similar  derivation  is  used.  Since  the  range  to  the 
target  is  unknown,  however,  a  nominal  range  of  about  2(XX)m  is  used  to  derive  the  Q  values. 
(This  is  not  atypical  for  land  engagements.)  A  cross-range  linear  velocity  change  of  0.555  m/s 
over  0.1s  at  a  range  of  20(X)m  results  in  an  angular  velocity  change  of  about  0.25  mrad/s.  Tlius 
the  discrete  noise  driving  the  horizontal  angular  velocity  state  will  be  assumed  to  have  a 
covariance  of 


=  (0.00025  rad/s)2 
=  6.25  X  10"*  rad^/s^ 


(A- 11) 
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so  that  again  from  (A-8), 


Qc""  Qkf  (ffc+i 
=  6.25  X  10"*  /  0.1 
=  6.25  X  lO"'^  rad^/s^ 

The  corresponding  vertical  angular  velocity  covariance,  assuming  the  similar  1/10  maneuver¬ 
ability,  results  in  a  of  6.25  x  10'^  rad^/s^. 
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APPENDIX  B.  DERIVATION  OF  Q  VALUES  FOR  THE  MRS  FILTER 


To  estimate  the  Q  matrices  for  the  muzzle  reference  filter,  we  take  a  similar  approach  as 
for  the  tracking  filters  in  Appendix  A.  First  we  must  determine  a  level  a  "maneuverability"  of 
the  gun  barrel  by  looking  at  some  of  the  collected  field  data.  For  the  same  sequence  of  data 
shown  in  Fig.  6-6,  the  angular  rate  and  acceleration  of  the  mantlet  are  shown  in  Fig.  B-1  and 
Fig.  B-2  respectively. 
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Fig.  B-1;  Mantlet  angular  rate 


Fig.  B-2:  Mantlet  angular  acceleration 


From  Fig.  B-2,  a  not  unreasonable  assumption  for  the  level  of  maneuverability  of  the  mantlet  can 
be  rather  arbitrarily  chosen  as  3  rad/s^.  For  the  60  Hz  sampling  rate  of  the  data  in  question,  this 
corresponds  to  an  angular  velocity  change  of  about  0.051  rad/s  in  1/60*  of  a  second.  Thus  we 
will  model  the  noise  driving  the  discrete  angular  velocity  state  as  an  uncorrelated  Gaussian 
sequence  with  zero  mean  and  covariance 


=  (0.051  rad/s)2 
=  0.0026  xddV 


(B-1) 


so  that  from  (A-8), 


=  0.0026  /  0.0166667  (B-2) 

=  0.16  rad^/s^ 

From  the  first  element  of  the  vector  equation  relating  the  noise  driving  the  angular  velocity  state 
with  the  noise  on  the  applied  torque  x,  Eqn.  (6-22),  we  can  conclude 
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EtT(I„)x(»j)]  =  0.16  /  0.1816^  5((,  - 

=  5  8(1^  -  (j) 


This  value  is  then  used  to  derive  the  remaintter  of  the  Q  elements  of  Chapter  6. 


(B-3) 


82 


SECURITY  CLASSIFICATION  OF  FORM 

(highest  clessificetion  sf  Title,  Abstract,  Keywords) 


DOCUMENT  CONTROL  DATA 

(Security  ctassification  of  title,  body  of  abstract  end  irtdexing  annotation  must  be  entered  when  the  overall  document  is  classified) 

1.  ORIGINATOR  (the  name  and  address  of  the  organization  preparing  the  document 

2.  SECURITY  CLASSIFICATION 

Organizations  for  whom  the  document  was  prepared,  e.g.  Establishment  sponsoring 

(overall  security  classificetion  of  the  document 

a  contractor's  report,  or  tasking  agency,  are  entered  in  section  8.) 

including  special  warning  terms  if  applicable) 

DEFENCE  RESEARCH  ESTABLISHMENT  OTTAWA 

Ottawa,  Ontario 

KIA  OK2 

UNCLASSIFIED 

3.  TITLE  (the  complete  document  title  as  indicated  on  the  title  page.  Its  classificetion 

should  be  indicated  by  the  appropriate 

abbreviation  (S.C  or  U)  in  parentheses  after  the  title.) 

Satie  Applications  of  Kalman  Filtering  in  Advanced  Land  Fire  Control  Systens  (U) 

4.  AUTHORS  (Last  name,  first  name,  middle  initial) 

Bird,  J.S. 

5.  DATE  OF  PUBLICATION  (month  and  year  of  publication  of 
document) 

April  1993 


64  NO.  OF  PAGES  (total 

containing  information.  Include 
Annexes,  Appendices,  etc.) 

82 


6b.  NO.  OF  REFS  (total  cited  in 
document) 


7.  DESCRIPTIVE  NOTES  (the  category  of  the  document,  e.g.  technical  report,  technical  note  or  memorandum.  If  appropriate,  enter  the  type  of 
report,  e.g.  Interim,  progress,  summary,  annual  or  final.  Give  the  inclusive  dates  when  a  specific  repotting  period  is  covered.) 

Technical  Report 


8.  SPONSORING  ACTIVITY  (the  name  of  the  department  project  office  or  laboratory  sponsoring  the  research  and  development  Include  the 
address.) 

Defence  Research  Establishment  (Dttawa 
Ottawa,  Ontario 
KIA  OK2 


9a  PROJECT  OR  GRANT  NO.  (if  appropriate,  the  applicable  research 
and  development  project  or  grant  number  under  which  the  document 
was  written.  Please  specify  whether  project  or  grwit) 

9b.  CONTRACT  NO.  (if  appropriate,  the  applicable  number  under 
which  the  document  was  written) 

0318E 

N/A 

1 0a  ORIGINATOR'S  DOCUMENT  NUMBER  (the  official  document 

10b.  OTHER  DOCUMENT  NOS.  (Any  other  numbers  which  may 

number  by  which  the  document  is  identified  by  the  originating 
activity.  This  number  must  be  unique  to  this  document) 

be  assigned  this  document  either  by  the  originator  or  by  the 
sponsor) 

DREO  REPORT  1172 

1  1.  DOCUMENT  AVAILABILITY  (any  limitations  on  further  dissemination  of  the  document,  other  than  those  imposed  by  security  classification) 
(X)  Unlimited  distribution 

(  )  Distribution  limited  to  defence  departments  and  defence  contractors;  further  distribution  only  as  approved 

(  )  Distribution  limited  to  defence  departments  and  Canadian  defence  contractors;  further  distribution  only  as  approved 

(  )  Distribution  limited  to  government  departments  and  agencies:  further  distribution  only  as  approved 

(  )  Distribution  limited  to  defence  departments:  further  distribution  only  as  approved 

(  )  Other  (please  specify): 


12.  DOCUMENT  ANNOUNCEMENT  (any  limitation  to  the  bibliographic  announcement  of  this  document  This  will  normally  correspond  to 
the  Document  Availabilty  (11).  However,  where  further  distribution  (beyond  the  audience  specified  in  11)  is  possible,  a  wider 
announcement  audience  may  be  selected.) 


Unlimited 


DCD03  2/06/87 


SECURITY  classification  OF  FORM 


